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2Q  abstract  (X^mrltauo  oa  rormrmm  tf  mid  Idonilfy  by  block  numbor) 

A  complete  simulation  of  missile  and  rocket  safing  and  arming  (SSA)  mech¬ 
anisms  containing  an  acceleration-driven  rotor,  a  th.ree-pass  involute  gear  train, 
and  a  pin  pallet  runaway  escapement  was  developed.  In  addition,  a  modification 
to  this  simulation  was  formulated  for  the  special  case  of  the  PATRIOT  M143  SSA 
mechanism  which  has  a  pair  of  driving  gears  in  addition  tc  the  three-pass  gear 
tra^n.  The  three  motion  regimes  involved  in  escapement  operation — coupled 
motion,  free  motion,  and  impact — arc  considered  In  the  computer  simulation. 
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20.  abstract  (cont) 

The  siruilation  det ermines  both  the  arming  time  of  the  device  and  the  non-impact 
contact  forces  of  all  interacting  components.  The  program  permits  parametric 
studies  to  be  made,  and  is  capable  of  analyzing  pallets  with  arbitrarily 
located  centers  of  mass.  A  sample  simulation  of  the  PATRIOT  M143  SiA  in  an 
11.9  g  constant  acceleration  arming  test  was  run.  The  results  were  in  good 
agreement  with  laboratory  test  data. 
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INTRODUCTION 


A  computer  slravilatlon  was  developed  for  missile  and  rocket  safltijl  and  arming 
(SSiA)  mechanisms  which  Incorporate  an  acceleration-driven  rotor,  a  thri'o-pass 
Involute  gear  train,  and  a  pin  pallet  runaway  escapement  (fig.  1).  A  modifica¬ 
tion  was  also  developed  which  simulates  a  system  with  a  i)alr  of  meshed  accelera¬ 
tion-driven  rotors  in  addition  to  the  three-pass  gear  train. 

Several  portions  of  the  computer  program  for  this  simulation  are  taken  di¬ 
rectly  from  the  program  SANDAS  of  reference  1.^ 

The  basis  of  the  computer  simulation  Is  the  development  of  mathematical 
equations  to  describe  the  three  regimes  of  motion  of  the  runaway  escapement: 
coupled  motion,  free  motion,  and  Impact  of  the  escape  wheel  and  pallet.  As  in 
reference  1,  the  effect  of  a  pallet  with  an  arbitrarily  located  center  of  mass  is 
considered,  and  all  non-impact  contact  forces  are  determined  for  considerations 
of  stength. 

VJlth  tills  simulation,  predictions  of  the  S&A  arming  time  can  he  made.  The 
arming  time  can  be  computed  either  for  a  variable  axial  and  normal  acce  U' rat  1  on 
field,  as  would  be  experienced  In  missile  or  rocket  flight,  or  for  a  constant 
axial  acceleration  field,  as  occurs  In  centrifuge  testing.  The  simulation  can  he 
used  to  determine  the  effect  of  design  changes  made  to  the  escapement,  gear 
train,  and  acceleration  driven  rotor.  Converselv,  design  changes  can  he  sug¬ 
gested  to  produce  a  desired  alteration  of  the  S&A  arming  time. 

In  this  report,  the  PATRIOT  M143  S&A  is  modeled  as  a  sample  mechanism.  The 
results  are  In  agreement  with  laboratory  test  data.  Details  of  the  input  parame¬ 
ters  needed  in  order  to  use  the  computer  program  are  completely  described  In  the 
Mis}  S&A  sample. 


DESCRIPTION  OF  OOMPOTER  PROGRAM  MISLSA 


The  computer  program  MISkSA  uses  logic  that  Is  virtually  Identical  to  that 
used  In  the  computer  program  '^ANDA}  of  reference  1.  A  complete  description  of 
MlSl.SA  Is  offered  here  for  clarity.  With  little  deviation,  the  description  of 
I'AN'DAB  offered  In  reference  1  applies  to  MlSl.SA  as  well,  and  shoulii  he  referred 
to  If  an  alternate  description  might  improve  the  reader's  understanding  at  any 
point  In  this  report. 


^  This  work  draws  to  a  considerable  extent  on  work  completeil  and  published  hy  Dr. 
F.  R.  TUjjjjei  and  Dr.  G.  G.  Lu>»c;-.  la  references  1  through  U . 
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Three  Regl*es  of  Notion 


The  computer  model  is  based  upon  toLLowlnt;  tlie  escape  wiieel  cont  1  lunnis  1  y 
throvigh  the  three  regimes  ot  motion  It  experiences.  Ai  tlcst,  the  escape  wheel 
and  entrance  pallet  pin  are  In  contact;  tlius,  upon  cxpe  r  lenc  I  n>;  .uce  lerat  ion ,  ti\e 
rotor  drives  the  entire  system  In  coupled  motion.  A  dl t terent tai  emiation  is 
developed  to  describe  this  coupled  raotloir.  The  pallet  pin  rides  alorrg  the  cscain- 
wheel  tooth  until  the  tip  is  reached  oi  the  contact  toice  becomes  zero,  at  which 
point  the  escape  wheel  system  (escape  wheel,  gear  train,  and  driving  rotor)  moves 
separately  from  the  pallet.  Here  separate  diifercntlal  euuatlons  a^e  needed  to 
describe  the  free  motion  of  both  the  pallet  and  escape  wheel  system  independent¬ 
ly,  A  new  escape  wheel  tooth  and  tiie  exit  pallet  pin  approach  each  otlier  thrmphi 
this  free  motion  until  impact  occurs.  Aoeordint,  to  the  severity  oi  the  impaet 
and  the  coefficient  of  restitution,  either  coupled  or  tree  motion  will  tollow 
this  impact.  Eventually,  the  escape  wheel  tooCh  will  readi  the  point  wiiere  tur- 
tlier  cont. ICC  with  the  exit  pallet  pin  is  not  possible,  and  a  new  ese.ipe  wheel 
tooth  will  approach  Che  entrance  pallet  pin.  This  cycle  repeats  itselt  sever. il 
hundred  times  within  a  matter  ot  3  to  A  seconds  in  the  case  oi  the  PAlXlt)!'  rtl  A  3 
S&A. 


As  can  be  seen  in  ttie  flow  chart  in  figure  2  freproduced  with  minor,  but 
necessary,  raodlfication  from  reference  1,  figure  5),  the  computer  progr.tm  must 
have  the  c.ipability  to  test  many  situations  and  make  several  decisions  in  order 
to  follow  the  escape  wheel  motion  accurately. 


Coupled  HoCloa 


Appendix  A  is  devoted  to  developing  the  o^uations  ot  motion,  both  i  ree  and 
coupled,  for  the  escape  wheel  system  and  pallet,  as  well  as  contact  force  expres¬ 
sions  between  each  gearing  lnterfe''e  and  at  the  escape  wheel-pallet  Intortace, 
when  applicable.  Equation  A-1A6  is  the  dltferentlal  eqoaLior.  ot  coupled  motion 
for  the  entire  system. 


Sb  * 


A  4 
59  ’ 


I  I  ) 


where  ^  represents  the  angular  position  ot  the  escape  wheel  (thus 


s  Llie  .ingu- 


lar  velocity  and  <{>  is  the  angular  acceleration).  .ind  A,^  are  tl  •  axial  and 

normal  or  lateral  accelerations,  respectively.  A^^  chrougti  are  v.irlables 

developed  through  a  series  of  force  and  moment  balances  througliout  the  system,  .is 
described  in  appendix  A.  The  solution  of  this  ill  f  terent  lai  equation  is  .iccom- 
plisbed  with  a  fourth  order  Runge-Kucta  routine.^  The  associated  computer  pro¬ 
gram  for  its  solution  is  given  in  Appendix  B.  Appropriate  setup  parameters  .ire 


^  RKGS  Routine,  IBM  System/ 360  Scientific  Subroutine  Package  ( 360A-C.M-OX3 )  , 
Version  Ill. 
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Inulation  of  pin  pall 


neoi’ssary  in  the  m.iin  program  to  utilize  tills  subroutini’  alonp,  with  two  ,ivUi  i - 
tloiial  subroutines  KCT  anj  Olill*.  The  subroutine  prc.-MMits  the  secoiul  orOi-r 

liltterentlal  equation  as  two  tlrst  orOcr  equat  Ions  to  KmIS, 

DPllU  1)  =  I’Hll  Vi; 

nriu  V2)  «  C-AAb'^  *  IMilv2)  **  >  +  ,V.\hi)  *  AA  +  AAiil  *  /VO/AAbh  V3; 

who  re 

=  PH[(  1  )  V4) 

i  =  PHI(2)  =■  DPHK  1)  Vh) 

i  =  DI'UU  1)  Vn; 


The  basic  responsibilities  ot  subroutine  i)UTP  are  to  write  tlie  output  ot  each 
increment  ot  the  solution  ol  the  diiterential  t'quation,  to  calculate  aiul  write 
the  contact  torces,  and  ti.)  detennlne  whether  coupKnl  motion  is  to  be  ci.)iU  1  luuni . 

Aside  from  the  main  prup,rdm  and  the  suhrouvines  mentioned,  several  oilier 
subroutines  are  ealled  in  the  solution  ot  the  coupled  niUlon  dr 1 1 efent ia  I  equa¬ 
tion  (as  well  as  the  tree  motion  d  1 1 1  ereiit  ia  I  equations). 


Subroutine  KlNtM 


This  suhroutine  computes  the  values  ot  the  moment  arms  A  b  C 

•  *  111 
and  D  '  as  well  as  values  ot  g,  i};,  and  ij).  Details  ot  the  development  ol  this 

subretlclne  are  given  in  retereiice  2;  a  briet  description  oi  the  parameters  g  and 
0  are  offered  here.  The  parameter  g  repnisents  the  distance  between  the  contact 
point  of  the  pallet  pin  with  the  escape  wheel,  and  the  cud  ol  the  escape  wheel 
tooth  Vfig.  3).  The  parameter  g  is  the  rate  of  change  ot  this  distance,  or  tne 
relative  linear  velocity  at  which  the  pallet  pin  is  approac hi iig  tlie  end  ol  the 

escape  wheel  tooth.  By  monitoring  this  parameter,  aloii^  with  the  calculateiJ 

contact  force  between  Clio  components,  ,  the  prof,ram  is  ahio  to  determine  when 
coupled  motion  has  ended.  If  the  contact  torce  is  positive  and  the  parameter  g 
is  negative  (due  to  the  direction  ot  the  un.t  vector  in  me  coordinate  system, 
appendix  A,  reference  2),  then  coupled  motion  continues.  At  the  point  where  g; 
becomes  zero  or  the  contact  torce  becomes  zero,  the  computer  program  ri-turns 
control  to  the  m.iiii  program  and  eventually  to  the  subroutines  devoted  to  the 

analysis  ot  free  motion. 

« 

i'  and  i)/  are  t!ie  angular  position  and  angular  velocity  ot  tlie  pallet, 

respect ively . 


S 


A  V 


*Ji  '.V  ■>  ~J‘  '  J  '->  J%.  ^ 


-•  4^t  ^ 


Subroutines  IN3  and  1N3A 


Tl\e  main  piir|i08c  ot  tUe^u  subrouClnos  is  to  detormiae  vaLiios  i  or  the 

variables  Al  throutJh  A57,  neodod  in  order  to  soWe  the  d  1 1  f  e  rent  la  I  onuattons. 
These  variables  are  developed  and  described  completely  in  .ippendlx  A.  (’I'wo  sub¬ 
routines  are  needed  due  to  a  Limit  on  the  number  ot  arguments  permitted  In  a 

single  subroutine.)  The  variables  are  represented  as  Aj\1  through  /\,\57  In  the 

computer  program  to  differentiate  these  variables  from  ttie  fixed  parameters  a^ 

through  dj  which  are  represented  as  A1  througli  Al  in  Llie  computer  program.  In 

addition  to  solving  for  the  variables  AAl  through  Aj\54,  subroutine  iNj  rlrst 

determines  the  appropriate  slgnum  functions  Sj  tnrough  needed  to  determine  AAl 
through  AA57.  These  slgnum  f unctions  are  needed  to  assure  that  friction  opposes 
the  motion  in  all  cases.  Slgnum  functions  S^,  S2,  and  S-^  are  developed  in  a 
manner  similar  to  thal  for  the  slgnum  function  S  described  in  reference  I,  appen¬ 
dix  A.  To  determine  slgnum  function  Sj  through  Sj ,  gear  train  angle  data  must  be 

updated  to  ascertain  whether  approach  or  recess  contact  is  present  at  each  gear 

;nesh.  Slgnum  fijnetions  and  are  desccibed  In  reference  l,  eipi.il  ions  A~Sd 

and  A-bf).  Finally,  slgnum  functions  and  S7  aie  discussed  In  appendix  A,  pre¬ 
ceding  equation  A-29. 

Subroutine  GCURVE 


% 


r-*: 

I  f . 


This  subroutine  is  called  in  order  to  obtain  the  current  values  tor  both 
tile  axial  and  normal  accelerations.  GCUKVh  accepts  up  to  lOU  points,  detining  an 
acceleration-time  curve  tor  botii  tlve  axial  and  normal  accelerations .  I’he  subrou 
tine  performs  a  linear  interpolation  to  determine  the  acceleration  values  at  eacl 
time  increment;  clien  converts  the  acceleration  values  icom  g's  to  In./sec^  fur 
use  in  the  differential  equation  solution. 


Free  Notion 


Several  subroutines  used  in  solving  the  free  motion  differential  equations 
are  the  same  as  those  needed  to  solve  the  coupled  motion  dlllerential  equation; 
namely,  KINEM,  1N3,  IN3A,  and  GCURVt.  Two  very  similar  subroutines  to  Fd'l'  and 
OUTP — FCTF  and  OUTPF — are  used  to  present  tlte  two  tree  motion  ditterentiai  equa¬ 
tions  to  KKGS  and  produce  tite  continuous  output.  Two  dltierentlal  equations  are 
needed,  one  for  the  pallet  in  free  motion,  and  one  tor  the  escape  wheel,  gear 
train,  and  drive  rotor  system.  These  equations  are  developed  in  appendix  A  and 
are  shown  here; 


t.' 
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'.V. 
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p  . 
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F  - 
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where  equation  7  Is  the  expression  for  the  free  motion  of  the  pallet  and  equation 
8  is  the  expression  for  free  motion  of  the  escape  wheel  system.  To  solve  both 
equations  at  the  sane  time,  the  two  second-order  differential  equations  are  pre¬ 
sented  in  a  single  subroutine,  I'CTF,  as  four  first-order  equations.  While  the 
equations  are  really  two  pairs  of  coupled  first-order  equations,  Che  routine 
treats  the  four  equations  as  coupled,  thus  giving  solutions  for  iji ,  [p,  and  their 
derivatives,  for  identical  time  increments.  The  equations  are  presented  in  sub¬ 
routine  FCTF  as  follows: 


DX(  1) 

=  X(2) 

(9) 

DXC  3) 

=  X(M 

(  =  i) 

(lU) 

(d=) 

DX(2)  = 

{AA67 

*  AA  +  AA68  *  Ais  “ 

AA66  *  X(2)  ** 

2)/AA65 

(11) 

(i|^) 

DX(4)  = 

(AAb3 

*  AA  +  AA64  *  Ai'J  - 

AA14  *  XC4)  ** 

2)/AA62 

(12) 

Again,  the  basic  responsibility  of  subroutine  UUTPF  is  to  compute  the  con¬ 
tact  rorces,  write  tiie  output  for  each  time  increment,  and  determine  whether  free 
motion  will  continue  at  the  next  time  Increment. 


Impact 


Transformation  from  free  motion  to  coupled  motion  usually  involves  an  impact 
between  tite  escape  wheel  and  pallet  pin.  When  tlie  program  has  decided  that  an 
impact  is  to  occur,  subroutine  IMPACT  is  called  to  determine  from  the  current 

•  *  •  • 

angular  velocities  .{>  and  ip  what  the  post  impact  angular  velocities  p  and  . 

will  be  by  applying  equations  F-20  and  F-21  of  reference  2,  (The  moment  or  iner¬ 
tia  Is  expressed  according  co  equation  A-169,  appendix  A,  which  refers  the  rotor 
atui  gear  train  inertia  to  the  escape  wheel  shatt.  As  sliown  in  reterence  2,  ap¬ 
pendix  K,  tangential  impact  has  been  neglected  and,  theretore,  «  1)^  and  F^  = 


In  certain  cases  tlic  impact  torque  on  the  escape  wheel  can  be  great  eiiough 
to  reverse  the  motion  of  the  en.lre  gear  train;  i.e,,  the  escape  wheel  velocity  ^ 
becomes  negative.  Tills  will  result  in  a  change  in  direction  of  the  frictional 
forces  which  must  be  aciouni.ed  lor.  This  change  In  tiie  friction  forces  must  be 
expressed  fur  both  tree  and  coupled  motion.  It  is  aiicomplished  by  allowing  the 
ciiefilcK-ut  of  friction  In  all  the  gear  train  components  to  become  negative  fret 
!,  app  li).  Subroutine  1N3  is  responsible  for  this  sign  change  by  using  the  toi- 

•  • 

lowing  signuin  function 

MU  -  AISStMU)  *  3,  I  i|  (  1 J) 

The  eoellieleni  (rlcLinn  of  y  is  used  lor  the  escapement  interlace  and  pallet 
|)lvot  area.  The  signum  funetlons  8,^  and  85  hanille  the  motion  reversals  lor  these 
two  siirface.s. 
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Transfer  Between  Motion  Regises 


The  main  program  and  subroutines  OUTP  and  OUTPF  are  responsible 
decision  process  to  determine  which  motion  regime  is  appi'diirt ate.  Wtiat 
Is  a  description  of  how  each  decision  Is  accomplished  by  the  simulation. 


for  the 
follows 


Coupled  Motion  to  Free  Motion 


With  each  Increment  of  the  numerical  solution  to  the  differential  equa¬ 
tion  of  coupled  motion,  subroutine  OUTP  checks  to  determine  If  coupled  motion 
continues.  Two  parameters  must  be  checked  to  make  this  determination,  g  and 
The  parameter  g  la  negative  when  the  location  of  the  pallet  pin  is  along  the 
escape  wheel  tooth,  and  Is  a  measure  of  the  distance  along  the  plane  of  the  tooth 
to  its  end.  (Again,  parameter  g  has  a  negative  value  due  to  the  direction  of  the 
unit  vector  In  the  coordinate  system  (ref  2,  app  A.))  P,.^  is  the  contact  force 

between  the  pallet  pin  and  escape  wheel  tooth.  The  statement, 

IF  ( .NOT.(r,.LT.O..ASO.PN.GT.O.>)  PRMT(5)  -  2.  (14) 

Is  used  to  make  this  test.  PRMT(5)  =  2.  (or  any  non-zero  PRMT(5)  value)  Is  a 
signal  to  the  subroutine  RKGS  that  coupled  motion  has  ended  and  to  return  control 
to  the  main  program.  At  the  point  control  is  returne'l  to  the  main  program,  the 
value  of  g  Is  Immediately  checked.  A  negative  value  of  g  Indicates  that  further 
contact  between  the  pallet  pin  and  the  escape  wheel  tonr.li  wlilch  had  Just  left 
coupled  motion,  could  still  occur.  This  depends  on  the  relative  angiilar  veloci¬ 
ties  of  the  pallet  and  escape  wheel  during  free  motion.  The  piogram  then  Ini¬ 
tializes  parameters  for  the  free  motion  subroutines  and  turns  control  over  to 
RKGS  to  solve  the  free  motion  differential  equations.  If  the  value  of  g  Is 
greater  than  zero,  however,  no  further  contact  Is  possible  with  that  escape  wheel 
tooth  before  a  new  escape  wheel  tooth  experiences  Impact.  Therefore,  angle  1  n- 
dexlng  (which  varies  according  to  whether  entrance  or  exit  action  Is  expectiiil, 
and  Is  yet  to  be  discussed)  must  take  place  before  continuing  to  the  free  motion 
regime. 


Free  Notion  Co  Impact,  Coupled  Motion,  or  Free  Motion 


Two  parameters  are  continuously  monitored  in  OUTPF  In  order  to  determine 
If  the  escape  wheel  system  and  pallet  remain  In  free  motion.  These  parameters 
are  f  and  g'  (fig*  4).  (Reference  2,  appendix  C  gives  the  details  of  how  these 
parameters  are  evaluated.)  The  parameter  f  Is  a  measure  of  the  distance  between 
the  pallet  pin  and  escape  wheel  tooth  taken  normal  to  the  plane  of  the  escape 
wheel  tooth.  The  parameter  g'  Is  similar  to  the  parameter  g  of  i;.)upled  motion  In 
that  It  measures  the  distance  from  the  pallet  pin  center  to  the  escape  wheel 
tooth  tip  along  the  plane  of  the  tooth.  First  the  parameter  f  Is  monitored.  If 
f  Is  not  positive,  control  is  returned  to  the  main  program.  With  f  less  than  or 
equal  to  zero.  If  g'  Is  greater  than  or  equal  to  zero,  no  contact  with  the  escape 
wheel  tooth  being  monitored  Is  possible.  Therefore,  after  the  appropriate  angle 
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Indexing  (according  to  whether  in  entrance  or  exit  action),  control  in  returned 
to  solving  the  free  motion  differential  equations.  If  g"  Is  less  than  zero,  how¬ 
ever,  sixteen  posslhilitles  most  be  considered  to  determine  whether  coipled  mo¬ 
tion.  free  motion,  or  Impact  will  result.  These  sixteen  possibilities  are  due  to 
llie  ilifferent  combinations  of  relative  velocities  of  the  escape  wheel  and  pallet; 
absolute  velocities  of  the  contact  points;  and  the  type  of  action,  entrance  or 
exit.  The  sixteen  possibilities  are  shown  here,  with  the  motion  that  will  result 
from  each  combination. 


Entrance  action 


i  >  0  and  >  0  and  >  |v^| 

ip  >  0  and  >  0  and  =  I'^gl 

1)  >  0  and  il)  >  0  and  |  <  | 

p  <  0  and  >  0 

p  >  0  and  <  0 

P  <  0  and  (p  <  0  and  Iv^j  >  Iv^j 

p  <  0  and  p  <  0  and  jv^l  ■  |V^| 

p  <  0  and  p  <  0  and  Iv  I  <  Iv  I 

'  p  '  8 

Exit  action 


free  motion 
cou  pi  ed  motion 
impac  t 
free  motion 
impact 
free  motion 
coupled  motion 
Impact 


p  >  0  and  p  <  0  and  IV  I  >  |v  I 

'  p '  's' 

p  >  0  and  p  <  0  and  |V  I  =  IV  I 

'  p  '  '3 

p  >  0  and  p  <  0  and  |V  I  <  |v  I 

p  8 

P  <  0  and  p  >  0  and  |v  I  >  IV  I 

'  p  '  's' 

p  <  0  and  p  >  0  and  IV  I  =•  |v  1 

'  p '  's' 

p  0  and  p  S  0  and  IV  I  <  |v  I 

'  p  '  '  s 

p  >  0  and  p  >  0 

p  <  0  and  p  <  0 


free  motion 
coupled  motion 
impac  t 
impact 

coupled  motion 
free  motion 
Impact 
free  motion 


Returning  to  OUTPF,  the  possibility  oi  g'  being  greater  than  zero  when  f 
Is  greater  than  zero  must  also  be  considered.  If  g'  becomes  greater  than  zero, 


control  is  returned  to  the  main  program.  In  the  main  program,  angle  indexing  is 
accomplished  after  determining  whether  entrance  or  exit  action  is  present,  and 
then  control  is  returned  to  the  numerical  routine  to  soive  the  free  motion  dit- 
ferential  equations. 


Impact  to  Free  or  Coupled  Motion 


The  subroutine  IMPACT  uses  the  input  angular  velocities  of  the  escape 
wheel  and  pallet  to  determine  the  angular  velocities  after  impact.  (The  equa¬ 
tions  are  developed  in  reterence  2,  appendix  F.)  Alter  the  impact  occurs,  the 
subroutine  returns  control  to  the  main  program.  The  main  program  first  tests  for 
entrance  or  exit  action;  then  computes  the  velocities  of  the  contact  points  V 
and  from  the  new  values  ^  and  \1/, .  If  the  absolute  value  of  the  difference  oF 

o  it 

t\ie  two  post-impact  velocities  is  less  than  1  inch  per  second;  i.e., 

|Vp  -  Vj  <  1.0  113) 

then  CO  .  -  '  is  transferred  to  solving  the  coupled  motion  difterential  equation. 
IE  this  is  not  the  case,  six  possibilities  exist  for  both  entrance  and  exit  ac¬ 
tion  which  lead  to  either  free  or  coupled  motion.  They  are  as  follows; 

Entrance  action 


• 

>  U 

and 

c-  >  i.) 

and 

IV  1 

> 

Iv  1 

tree  motion 

'  P' 

• 

« 

>  0 

and 

i;)  > 

and 

IV  1 

P 

< 

1V,1 

coupled  motion 

• 

« 

>  0 

and 

<  0 

coupled  motion 

« 

<  0 

and 

1^)  >  0 

free  motion 

• 

0 

and 

Jr  <;  0 

and 

IV  1 

> 

|V  1 

coupled  motion 

p 

» 

u 

and 

<;  u 

and 

Iv  i 

< 

Iv  1 

free  motion 

p 

Exit  ac 

t  io>i 

1 

>  0 

and 

+'  0 

and 

i'^'  1 

> 

|V  1 

tree  saotlon 

p 

>  0 

and 

^  .  n 

and 

IV  1 
p 

< 

ivj 

covipled  motion 

>  •) 

and 

C'  s  0 

coupled  motion 

• 

4> 

<  1.) 

C)  V  0 

tree  motion 

• 

t  U 

and 

:  >0 

and 

IV  1 

> 

|V  1 

coupled  motion 

p 

4> 

t  0 

and 

and 

iV  I 

3 

|V..  1 

true  motion 
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Additional  Program  Features 


Angle  Indexing 


In  the  description  of  the  operation  of  the  computer  program,  angle  i  n- 
de'tlng  >i^a.s  mentioned  several  times.  Angle  Indexing  is  necessitated  by  the  chang¬ 
ing  of  the  relative  positions  of  the  escape  wheel  and  pallet  pin.  It  Inv. lives 
going  from  entrance  to  exit  motion  or  vice  versa.  As  an  example,  when  control  Is 
released  to  the  main  program  from  the  routines  to  solve  the  coupled  motion  dtr- 
ferentlal  equation,  and  g  >  0,  Che  current  escape  wheel  angle  Is  measured  against 
a  test  angle  TANG.  If  the  escape  wheel  angle  is  less  than  this  test  angle,  it  is 
known  that  the  entrance  action  coupled  motion  has  been  completed,  and  the  escape 
wheel  angle  <1  is  Indexed  forward  NT  teeth,  and  the  pallet  angle  Is  incremented 
by  2it  -  X  In  preparation  for  analysis  during  exit  action  ( X  is  the  angle  between 
the  pallet  pins).  Conversely,  if  the  escape  wheel  angle  is  greater  chan  tlie  test 
angli‘,  it  is  known  that  exit  action  coupled  motion  has  terminated  and  entrance 
action  is  expected.  To  return  to  entrance  action,  the  escape  whei>l  angle  Is 
indexed  hack  (NT  +  1)  teeth,  and  Che  pallet  angle  Is  decremented  by  -Zm  +  X. 

In  addition  to  indexing  the  angle  of  the  escape  wheel  to  accommodate 
changes  from  entrance  to  exit  action,  the  same  must  he  done  for  the  pallet  center 

of  mass  angle  <|)  .  During  entrance  action,  this  angle  Is  expressed  as 
c 

or  PSICC 
c 

while  during  exit  action,  the  angle  Is  expressed  as 

+  X  or  PSICC  +  LAMBDA  *  7.7. 
c 

The  multiplication  by  ZZ  Is  a  conversion  from  degrees  to  radians. 


sas. 


Cumulative  Escape  Wheel  Angle 


To  solve  the  differencial  equations  as  well  as  to  determine  when  arming 
has  occurred,  the  instantaneous  rotor  angle  must  be  known.  This  angle  is  ex- 
pres-,ed  in  appendix  A  as  $  +  <t)^  where  4)^^  is  the  initial  rotor  angle,  (Ji^  is 

the  cumulative  angle  of  rotation  of  the  escape  wheel,  and  is  the  gear  ratio 

between  the  rotor  and  escape  wheel.  Since  angle  Indexing  is  occurring  with  tlie 
angle  (ji,  the  Runge-Kutta  variable  PHI(l),  4)  can  only  be  obtained  by  cone  I  u.iius 
addition  of  the  Increments  due  Co  each  Runge-Kutta  cycle.  Therefore, 


where 


6  +  Ad 

Vtot  ^ 


"^TOT  total  escape  wheel  angle  up  to  a  given  Runge-Kutta  cycle 
(PHITOT  in  computer  program) 


=  increment  ot  escape  wheel  during  a  given  Runge-Kutta  cycle 

The  increment  is  calculated  as  the  ditference  between  the  latest  value  ot  (Ji 
[PHKD]  and  the  previous  value  of  <{»  (PHIPR).  With  this,  equation  16  becomes 

=  PHITOT  +  PHI(l)  -  PHIPR  (17) 

The  program  reads  in  the  escape  wheel  angular  displacement  at  which  the 
mechanism  arras  (which  for  instance  might  be  a  90  degree  rotor  displacement  multi¬ 
plied  by  the  gear  ratio  between  the  rotor  and  escape  wheel).  After  every  incre¬ 
ment,  PHITOT  is  compared  with  this  "cut-off"  angle  PHICUTD,  and  the  simulation  is 
terminated  when  PHITOT  reaches  PHICUTD.  Additional  information  on  the  computa¬ 
tion  of  i  can  be  obtained  from  the  section  on  Fuze  Body  Configuration  in  refer- 

1  T 

ence  1 . 


Subroutine  ALFA 


This  subroutine  is  needed  in  the  solution  or  the  differential  equations 
of  both  coupled  and  free  motion.  Values  for  the  initial  (earliest  possible)  and 
final  (latest  possible)  contact  angles  of  the  gear  meshes  are  determined  in  tliis 
subroutine,  whicl)  is  called  by  the  main  program  for  each  mesh.  (Details  ot  the 
development  of  this  subroutine  are  available  in  reterence  3,  appendix  A.)  These 
Initial  and  final  gear  mesh  angles  are  needed  in  order  to  compute  the  instanta¬ 
neous  gear  mesh  angles  in  subroutine  in3.  These,  in  tarn,  are  needed  in  the 
solution  of  the  differential  equations. 


Maxlaun  Contact  Forces 

The  subroutines  OUT'P  and  UUTPF  use  expressions  developed  in  appendix  A 
of  this  report  to  calculate  the  contact  forces  at  each  gear  mesh.  In  addition, 
when  the  pallet  pin  and  escape  wheel  are  in  coupled  motion,  a  contact  force  ex¬ 
ists  between  them  and  Is  calculated  in  OUTP.  It  is  calculated  with  two  expres¬ 
sions,  one  in  terms  of  the  escape  wheel  variable  and  one  in  terras  of  the  pallet 
variable  vj;.  This  serves  as  a  check  on  the  accuracy  of  Che  equations  developed, 
since  It  is  known  that  the  contact  force  should  be  the  same  for  both  calcula¬ 
tions. 

Both  subroutines  keep  track  ot  the  maxlmura  contact  force  at  each  inter¬ 
face  experienced  through  the  arming  cycle,  and  return  this  information  to  the 
main  program. 


Program  lopuC/Output 


Tile  input  parameters  needed  tor  the  computer  program  are  discussed  in  uetall 
in  the  sample  run  tor  the  PATRIOT  M143  S<*A. 
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The  output  of  the  program  begins  with  a  summary  of  all  of  the  Input  parame¬ 
ters  given.  Following  this,  the  program  begins  by  solving  the  differencial  cqua- 


tlon  of  coupled  motion.  For  each  time  Increment  of  the  numerical  solvition  to  the 
differential  equation,  the  following  parameters  are  printed. 

T 

a 

t 

- 

time  (sec) 

PHID 

A 

a 

Instantaneous  escape  wheel  angle  (deg) 

PHIDOT 

- 

* 

ai 

angular  velocity  of  escape  wheel  (rad/sec) 

G 

9 

R 

a 

distance  from  pallet  pin  to  end  of  escape  wheel 
tooth  along  the  plane  of  the  tooth  (negative  for 
coupled  motion  to  exist)  (In.) 

GDOT 

a 

R 

a 

time  rate  of  change  of  the  parameter  g,  or  relative 
velocity  of  pallet  pin  along  the  escape  wheel  tooth 
( in . /sec) 

PSID 

a 

a 

pallet  angle  (deg) 

PS I DOT 

A 

« 

a 

angular  velocity  of  pallet  (rad/sec) 

PHI TOT 

B 

= 

cumulative  escape  wheel  angle  (deg) 

F34 

m 

^34 

= 

normal  contact  force  between  gear  no.  3  and  pinion 
no.  4  (ibf) 

F23 

* 

^23 

s 

normal  contact  force  between  gear  no.  2  and  pinion 
no.  3  (lb£) 

F12 

^12 

m 

normal  contact  force  between  gear  no.  1  and  pinion 
no.  2  (Ibf) 

PN 

■ 

Pn 

* 

normal  contact  force  between  escape  wheel  and  pallet 
(Ibf)  (calculated  with  equation  in  terms  of  the 
escape  wheel  variable  41) 

PNPSI 

* 

P  , 

n\l/ 

A 

normal  contact  force  between  escape  wheel  and  pallet 
(Ibf)  (calculated  with  equation  in  terms  of  the 
pallet  variable  ij;;  should  be  equal  to  PN) 

DPHI2 

a 

a 

2 

angular  acceleration  of  escape  wheel  (rad/sec  ) 

The  output  continues  in  this  manner  until  the  free  motion  regime  is  reached.  The 
output  for  free  motion  Is  as  follows: 

T  =  t  =•  time  (sec) 

PHID  =■  I?  ”  Instantaneous  escape  wheel  angle  (deg) 

PHIDOT  =*  $  =■  angular  velocity  of  escape  wheel  (rad/sec) 
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PSIU 


-  =  pallet  angle  (deg) 

PSIDOT  “  ’])  “  angular  velocity  of  pallet  (rad/sec) 

PHITOT  ^  '('•p  “  cumulative  escape  wheel  angle  (deg) 

FK12  “  ^K12  "  normal  contact  force  between  gear  no.  1  and  pinion 

no.  2  (Ibf) 

FP23  "  ^F23  “  normal  contact  force  between  gear  no.  2  and  pinion 

no.  3  (Ibf) 

FF34  =  =  normal  contact  force  between  gear  no.  3  and  pinion 

no.  4  (Ibf) 

When  impact  is  sensed,  the  following  parameters  are  written 

VP  =  V  =  velocity  of  the  contact  point  of  the  pallet  pin 

(in. /sec)  (first  printed  just  prior  to  impact) 

VS  =  Vg  =  velocity  of  the  contact  point  of  the  escape  wheel 

tooth  (in. /sec)  (first  printed  just  prior  to  impact) 

Next,  immediately  after  Impact,  the  parameters  PHID,  PHIDOT,  PSID,  PSIUOT,  and 
PHITOT  are  printed,  as  well  as  the  post-impact  values  tor  VP  and  VS. 

Upon  the  termination  of  the  computer  program,  the  final  values  printed  are 
the  maximum  contact  forces  experienced  at  each  interface  during  both  free  and 
coupled  motion,  and  the  arming  time  of  the  device. 

Within  the  program,  statements  have  been  added  in  order  to  reduce  the  out¬ 
put.  The  time  increment  being  used  in  the  numerical  analysis  of  the  differential 
equations  is  0.001  second,  and  In  the  case  of  the  PATRIOT  M143  SaA,  an  arming 
time  of  approximately  3  to  4  second  Is  expected.  This  would  result  in  approxi¬ 
mately  30,000  to  40,000  lines  of  output.  In  order  to  limit  this  output,  state¬ 
ments  have  been  added  to  allow  full  prlnt-out  of  only  the  first  and  last  30  de¬ 
grees  of  escape  wheel  travel  (In  ttie  caae  of  the  M143  S6A,  tlie  escape  wheel  trav¬ 
els  over  13,000  degrees  in  the  arming  process).  The  output  between  the  first  and 
last  30  degrees  is  limited  to  every  1 ,000th  line  with  further  control  statements. 
All  output  control  statements  can  be  easily  removed  or  altered  to  suit  the  needs 
of  the  user. 


OOHPUTEK  SIMULATION  OF  AN  EXAMPLE  MECHANISM 


Because  the  PATKLuT  M143  S<>A  actually  has  a  four-pass  gear  train  due  to  the 
mesh  between  tlie  two  driving  rotors,  some  minor  inodit  lent  ions  had  te.  bo  made  to 
the  analysis  and  to  the  comi)uter  program.  The  revised  analysis  is  given  in  ap¬ 
pendix  C  and  the  associated  computer  program  is  shown  in  appendix  u.  This  baA 
will  now  be  used  as  a  sample  mechanism.  The  balance  rotor  will  be  used  as  the 


lf> 


driving  rotor.  The  input  parameters^  needed  to  simulate  the  M1A3  S6(\  in  an  11.9 
g  centrifuge  arming  test  are  described  In  detail  below: 


Kacapeaeot  Paraaetera 


A 


B 

C 


a  »  0.1996  (in.)  (B.0698  mm)  distance  between  the  pallet 

and  escape  wheel  pivot  cen¬ 
ters 

b  ■  0.1495  (In.)  (3.7973  mm)  =  escape  wheel  radius 

c  »  0.1188  (In.)  (3.0175  mm) distance  from  pivot  center 

to  pin  center  of  pallet 
(Identical  for  entrance  and 
exit) 


R 

ALPHA 

EREST 


LAMBDA 


DELTA 


r 


a 


X 


5 


0.01575  (in.)  (4.0005  mm)  " 
45.0  deg  “ 

0.0 

108.42  deg 

30.0  deg  =» 


pallet  pin  radius  (identical 
for  entrance  and  exit) 

escape  wheel  tooth  half 
angle 

coefficient  of  restitution 
(high  speed  motion  pictures 
of  runaway  escapements  indi¬ 
cate  totally  inelastic  im¬ 
pacts) 

angle  formed  between  pallet 
pins  with  radii  taken  to 
pivot  center 

angle  between  individual 
escape  wheel  teeth 


Reference  2  gives  further  details  of  these  parameters,  if  needed. 


Hass  Properties  of  Coaponents 


Ml 


mj 


2.6775  X  10”  Ib-sec'^/in.  =  mass  of  rotor  assembly 
(4.6963  X  10"^  kg) 


3 


All  rotor  input  parameters  subscripted  with  a 


are  those  of  the  balance  rotor. 
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12 

BS 

in  2 

- 

1.9324  X  10“^  Ib-sec^/in. 
(3.3894  X  10"^  Rii) 

■ 

mass  of  no.  2  gear  and 
pinion  assembly 

13 

= 

1.2183  X  10"^  Ib-sec^/in. 
(2.1372  X  10“^  kg) 

- 

mass  of  no.  3  gear  and 
pinion  assembly 

14 

= 

">4 

= 

1.0570  X  10“^  Ib-sec^/ln. 

(  1  .8540  X  lO"'^  kg) 

- 

mass  of  escape  wheel  and 
pinion  no.  4  assembly 

s 

“P 

m 

5.3540  X  10~^  Ib-sec^/ln. 
(9.3909  X  10"^  kg) 

- 

mass  of  pallet  assembly 

11 

m 

s 

8.2140  X  10"^  in.-lb-sec^ 
9.2952  X  10"^  kg-m) 

9 

moment  of  inertia  of 
rotor  assembly 

12 

m 

^2 

a 

1.3692  X  10“^  in.-lb-sec^ 
(1.5494  X  10“^O  kg-ra) 

- 

moment  of  inertia  of  no.  2 
gear  and  pinion  assembly 

13 

= 

h 

= 

8.5991  X  10"^  in.-lb-s.ec^ 
(9.7317  X  10“^°  kg-ro) 

= 

moment  ot  inertia  ot  no.  3 
gear  and  pinion  assembly 

14 

= 

I4 

a 

6.899b  X  lO"*^  in.-lb-sec^ 
(7.8078  X  10“^^  Ug-m) 

moment  ot  inertia  of  escape 
wheel  and  no.  4  pinion 
assembly 

IP 

a 

e 

6.8390  X  10'®  in. -lb-sec^ 
(7.739  X  10”^  kg-ra) 

m 

moment  ot  inertia  of  pallet 
assembly 

General 

Paraaeters 

RCl 

a 

^cl 

= 

0.2656  in. 

(  6.7  462  ri.ra) 

- 

distance  from  rotor  pivot 
center  to  center  ot  mass 

RCP 

a 

*^cp 

a 

0.0  in. 

(0.0  mra) 

ta 

pallet  eccentricity  or  dis¬ 
tance  from  pivot  center  to 
center  of  mass 

RHOP 

s 

p 

p 

= 

0.0152  in. 

(0.3861  rara) 

a 

pallet  pivot  radius 

I’HIICD 

= 

A 

"Ic 

a 

45.0  deg 

'a 

rotor  angle  in  starting 

position  (fig.  1) 

PSICJ). 

= 

'll 

c 

= 

0  deg 

eccentricity  angle  of  pallet 
(fig.  1) 

p  H  i  0 

133.45  dCfe 

s 

escape  wheel  starting  an^^ie 
ot  initial  coupled  motion 
simulation  (tor  choice  ot 
this  angle,  see  ret  2) 

PHICUTD  -  13,268  de^ 


MU  “  U  “0.10 


MUl  =  Pj  ■  0.10 

BMTAID  =»  ■* 


BETA2D  =  ^2  " 


BETA3D  =>  ®3  “  180.0  deg 


BETA4D  “  8/  “  180.0  deg 

k 


cumuljitive  escape  wliee  1 
aiii^le  at  whlcU  arming  oc¬ 
curs,  obtained  trom  product 
ot  gear  ratio  and  known 
rotor  displacement  necessary 
tor  arming 

coetticient  ot  triction  ot 
geai  train  (.pivots,  tootn- 
to-tootb  contacts,  and  es¬ 
cape  wlieel  pivot) 

coetticient  ot  triction  ot 
pallet-escape  wheel  inter¬ 
lace  and  pallet  pivot 

angle  between  lateral  axis 
(x-axis)  and  line  trom  rotor 
pivot  to  no.  2  gear-and- 
pinion  assembly  pivot  (tig. 
1) 

angle  between  l.tteral  axis 
and  line  trom  no,  2  gear  and 
pinion  assembly  pivot  to  no, 
3  gear  and  pinion  assembly 
pivot  (.tig.  1) 

angle  between  lateral  axis 
and  line  trom  no.  3  gear  and 
pinion  assembly  pivot  to 
escape  wheel  and  pinion 
assembly  pivot  (tig.  1) 

angle  between  lateral  axis 
and  line  trom  escape  wneel 
and  pinion  assembly  pivot  to 
pallet  assembly  pivot  (.tig, 
1) 


Clear  Parameters 


PSUBUl 

f'dl  “ 

75.4 

=  diametral  pitch  ot  mesh 

1  (.rotor  and  pinion  no.  2 

no . 

} 

PSUBD2 

9 

Pd2  “ 

96.5 

=  diametral  pitch  ot  mesh 

2  (gear  no.  2  and  pinion 

3) 

no  • 

no  • 
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PSUBD3 


10?.. 9 


diametral  pitch  of  mesh  no. 
3  (gear  no.  3  and  escape 
wheel  pinion) 


NGl  “  Nqj  “111  =  number  of  teeth  of  rotor 

(full  gear  no.  1) 


NG2 

Ng2 

9 

30 

number  of  teeth  of  gear  no. 
2 

NG3 

Ng3 

= 

30 

= 

number  of  teeth  of  gear  no. 
3 

NP2 

9 

Np2 

= 

10 

9 

number  of  teeth  of  pinion 
no.  2 

NP3 

Np3 

8 

a 

number  of  teeth  of  pinion 
no .  3 

NP4 

= 

Np4 

= 

8 

- 

number  of  teeth  of  pinion 
no.  4  (escape  wheel  pinion) 

CAPRPl 

= 

= 

0.73410  In. 

(18.64614  mm) 

= 

pitch  radius  of  gear  no.  1 
( rotor) 

CAPP.P2 

= 

S 

0.15545  in. 

(3.94843  mm) 

a 

pitch  r  vdlus  of  gear  no.  2 

CAPRP3 

rt 

^p3 

= 

0.14575  In. 

(3.70205  mm) 

a 

pitch  radius  of  gear  no.  3 

RP2 

''p2 

= 

0.06635  in. 

(1.68529  mm) 

- 

pitch  radius  of  pinion  no.  2 

RF3 

= 

''p3 

= 

0.04145  in. 

(  1  .05283  mm) 

■» 

pitch  radius  of  pinion  no.  3 

RP4 

a 

0.03885  in. 

(0.98679  mm) 

= 

pitch  radius  of  pinion  no.  4 
(escape  wheel  pinion) 

THKTAl 

s 

= 

20.0  deg 

- 

pressure  angle  of  mesh  no.  1 

THETA2 

= 

°2 

= 

20.0  deg 

a 

pressure  angle  of  mesh  no.  2 

THKTA3 

= 

°3 

= 

20.0  deg 

= 

pressure  angle  of  mesh  no.  3 

RHOl 

9 

= 

0.0770  in, 

( 1  .^558  mm) 

a 

pivot  radius  of  rotor 

RH02 


O.OIRO  in. 
(0.4826  nm) 


pivot  radius  of  no.  2  gear 
and  pinion  assembly 


RH03 

^3 

a 

0.0154  In. 

(0.3912  mm) 

m 

pivot  radius  of  no.  3  gear 
and  pinion  assembly 

RH04 

= 

=• 

0.0154  In. 

(0.3912  ram) 

= 

pivot  radius  of  escape  wheel 
and  pinion  no.  4  assembly 

CAPRBl 

Si 

a 

0.7115  In. 

(18.0721  mm) 

a 

base  radius  of  gear  no.  1 
(rotor) 

CAPRB2 

B 

S2 

a 

0.1425  In. 

(3.6195  ram) 

= 

base  radius  of  gear  no.  2 

CAPRB3 

= 

S3 

= 

0.1340  In. 

(3.4036  ram) 

m 

base  radius  of  gear  no.  3 

RB2 

= 

^b2 

a 

0.04375  in. 

(1.11125  mm) 

= 

base  radius  of  pinion  no.  2 

RB3 

3 

''b3 

B 

0.02700  In. 

(0.68580  mm) 

= 

base  radius  of  pinion  no.  3 

RBA 

= 

a 

0.02450  in. 

(0.62230  mm) 

base  radius  of  pinion  no.  4 

CAPROl 

= 

Si 

a 

0.75250  In. 

(19,1135  mm) 

- 

outside  radius  of  gear  no.  1 

CAPR02 

ta 

S2 

a 

0.16630  in. 

(4.22402  mm) 

a 

outside  radius  of  gear  no.  2 

CAPR03 

a 

S3 

a 

0.15615  In. 

(3.96621  mm) 

a 

outside  radius  of  gear  no.  3 

R02 

= 

S? 

a 

0.07585  In. 
(1.92659) 

a 

outside  radius  of  pinion  no. 

2 

R03 

a 

S3 

a 

0.04915  In. 

(  1 . 2484 1  mm) 

a 

outside  radius  of  pinion  no. 

3 

R04 

a 

S4 

a 

0.04660  In. 

( 1 . 18364  mm) 

a 

outside  radius  of  pinion  no, 

4 

J1 

s 

0 

initialization  parameter  for 
mesh  no.  1  (zero  corresponds 
to  the  earliest  possible 
contact  of  mesh,  reference 
3) 

J2 

3 

J2 

» 

0 

a 

Initialization  parameter  for 
mesh  no.  2 

J3 

a 

s 

a 

0 

a 

Initialization  parameter  for 

J3 


0 


Initialization  parameter  for 
mesh  no.  3 


Angle  Indexing  ParaaeCers 


TANG  =  160  deg  =  escape  wheel  angle  at  which 

coupled  raoclon  Is  no  longer 
possible  (see  reference  1  to 
choose  this  angle) 

NT  =2  =  number  of  escape  wheel  teeth 

spanned  by  the  pallet  pins 
when  In  entrance  coupled 
motion 


Paraaeters 

Needed 

for 

M143  TVo-Rotor  System 

BD 

= 

97.3  deg 

=  detonator  rotor  angle  In 
starting  position  (app  B) 

RD 

s 

0.17349  in. 

(4.40665  mm) 

“  distance  from  detonator 

rotor  pivot  center  to  center 
of  mass 

ID 

= 

Id 

= 

6.9974  X  10"^  in. -lb-sec^ 
(7.9185  X  10"^  kg-m^) 

“  moment  of  Inertia  of  deto¬ 
nator  rotor 

MD 

s 

"’d 

SK 

2.679  X  10"“^  In.-sec^/lb 
(4.699  X  10"^  kg) 

=  mass  of  detonator  rotor 

Acceleration  Defining  Faraaeters 


N  •■2  “  number  of  points  used  to 

define  the  acceleration 
profile 

TIM(J),  where  J  =  1  to  N  =•  time  data  points  for  accel¬ 

eration  profile  (sec) 

r.A(J)  =•  axial  acceleration  data 

points  corresponding  to 
TIM(J)  data  points  (g’s) 

GL(J)  “  lateral  (normal)  accelera¬ 

tion  data  points  correspond¬ 
ing  to  TIM(J)  data  points 

(g’e) 
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RESULTS 


The  program  M143SA  and  the  computer  output  tor  the  run  which  simulates  the 
M143  S&A  in  an  11.9  g  centrltuge  arming  test  are  listed  in  appendix  1).  The  re¬ 
sults  predict  S4A  arming  in  3.57  seconds.  This  falls  well  within  the  arming 
specification  of  3.1  to  4.2  seconds.  The  maximum  non-impact  contact  forces  cal¬ 
culated  in  the  program  are  as  follows: 


2^  “  0.04  Ibt 

*'F34 

(0.018  kg) 

23  -  0.20  Ibt 

^'>'34 

(0.091  kg) 

j2  “  0.75  Ibt 

^'k12 

(0.340  kg) 

=  0.01  Ibt 

(0.005  kg) 


0.03  Ibt 
(0.014  Kg) 

0.18  Ibf 

(0082  kg) 

0.66  Ibt 
(0.299  kg) 


conclusions 


With  this  simulation,  an  increased  capability  to  analyse  various  sating  and 
arming  (S4A)  mechanisms  has  been  achieved.  This  capability  to  date  includes 
artillery  S&A  mechanisms  (spin  driven)  with  involute  two-  and  three-pass  gear 
trains  and  pin  pallet  runaway  escapements  (ref  1),  artillery  St»k  mechanisms  in  an 
aeroballistlc  environment  with  two-pass  involute  gear  trains  and  st raiglit-sided 
verge  runaway  escapements  (ref  4),  and  now  missile  and  rocket  S&A  mechanisms  with 
involute  three-pass  gear  trains  and  pin  pallet  runaway  escapements. 

The  computer  simulation  developed  in  this  report  has  been  shown  to  be  appli¬ 
cable  to  Che  PATRIOT  M143  S^A  after  some  slight  modifications.  The  results  were 
In  good  agreement  with  the  specification  requirement  for  this  raec.hanlsm. 


RECOMMENDATIONS 


The  M143  aafing  and  arming  (S4A)  mechanism  is  currently  the  subject  oi  a 
study  to  improve  the  producibillty  ot  the  device.  Changes  generated  througii  this 
study  may  affect  the  timing  function  of  the  device.  The  computer  simulation 
developed  here  should  be  used  in  conjunction  with  laboratory  testing  to  recommerui 
adjustments  to  the  escapement  assembly  so  that  the  S'nA  can  cotitinue  to  meet  its 
arming  time  specif icatlon. 
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APPENDIX  A 

DYNAMICS  OF  ROTOR  DRIVEN  MISSILE  OR  ROCKET  S&A  MECHANISM  WITH 
A  THREE-PASS  INVOLUTE  GEAR  TRAIN  AND  A  PIN  PALLET  RUNAWAY  ESCAPEMENT 


This  appendix  gives  derivations  for  a 
slle  or  rocket  3&A  mechanism  consisting  of 
a  three-pass  involute  step-up  gear  train. 
The  configuration  of  this  model  is  shown  In 


complete  mathematical  model  of  a  mls- 
a  rotor  driven  by  axial  acceleration, 
and  a  pin-pallet  runaway  escapement, 
figure  A-1. 


This  work  was  patterned  to  follow,  to  a  considerable  extent,  work  done  by  G. 
G.  Lowen  and  F.  R.  Tapper  In  reference  1.  That  work,  In  turn,  draws  to  a  large 
degree  on  previous  efforts  by  the  above-mentioned  authors;  l.e.,  the  dynamics  of 
the  pin-pallet  runaway  escapement  (ref  2)  and  the  analysis  of  fuze  gear  trains 
(ref  3).  As  In  reference  1  and  2,  the  following  three  regimes  of  Che  mechanisms 
are  consldered:^”^ 


1.  Coupled  Motion 

The  escape  wheel  Is  In  contact  with  one  of  the  pallet  pins  while  it 
Is  driven  by  the  rotor  (gear  no.  1)  through  the  gear  and  pinion  sets  nos  2  and 
3.  The  coupled  motion  differential  equation  Is  written  In  terms  of  the  escape 
wheel  variable  and  is  obtained  by  combining  the  solutions  to  the  Newtonian  force 
and  moment  expressions  for  the  individual  mechanism  components. 

2.  Free  Motion 

The  pallet  and  the  escape  wheel,  gear  train,  rotor  system  move 
Independently  of  each  other  during  this  phase  of  motion.  A  differencial  equation 
Is  required  to  describe  the  motion  of  each.  The  differential  equation  of  the 
pallet  is  expressed  In  terms  of  the  pallet  variable  )}>,  and  that  of  the  combined 
system  In  terms  of  the  escape  wheel  variable 

3.  Impact 

The  formulation  of  the  Impact  regime  Is  taken  directly  from  refer¬ 
ence  2,  except  now  the  moment  of  Inertia  of  the  escape  wheel  and  pinion  no.  4 
also  contains  the  referred  mass  properties  of  the  rotor  and  gear  pinion  sets  nos 
2  and  3.  This  Impact  simulation  Is  based  on  the  classical  angular  Impulse  momen¬ 
tum  model,  where  a  coefficient  of  restitution  is  used  to  account  for  the  energy 
losses.  It  is  assumed  that  the  effect  of  the  Impact  force  between  the  escape 
wheel  and  the  pallet  is  significantly  greater  than  the  effect  of  the  driving 
torque  of  the  rotor  and  the  various  retarding  torques  caused  by  friction.  There¬ 
fore,  the  driving  torque  of  the  rotor  and  the  retarding  torque  are  not  considered 
In  the  model. 

The  Influence  of  friction  forces  is  considered  both  In  tlie  coupled  and  free 
motion  regimes.  There  Is  friction  at  the  escape  wheel-pallet  Interface  during 
coupled  motion,  and  there  is  friction  between  the  gear  teeth  and  at  all  pivots 
during  both  of  these  regimes.  As  In  references  1  and  3,  the  Individual  pivot 
friction  torques  are  obtained  by  the  algebraic  addition  of  the  two  friction 
forces  due  to  the  x  and  y  components  of  Che  normal  bearing  forces,  rather  than  by 
direct  use  of  the  resulting  normal  forces.  This  conservative  approach  to  fric¬ 
tion  Is  necessary  In  order  to  avoid  difficulties  which  the  presence  of  a  square 
root  Introduces  into  the  solutions  of  various  differential  equations. 


For  a  more  detailed  description,  consult  figures  In  reference  2, 
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The  following  outlines  the  derivations  of  the  differential  equations  for 
both  free  and  coupled  motion  as  well  as  the  development  of  contact  force  expres¬ 
sions  . 


Dynaaics  of  the  Pallet  lo  Coupled  Motion 


The  dynamic  analysis  of  the  pallet  is  most  conveniently  performed  in  the 
primed  coordinate  system  (fig.  A-l).  The  coefficient  of  friction  at  the  pallet- 
escape  wheel  Interface  and  at  the  pallet  pivot  has  the  designation 

With  representing  the  axial  acceleration  of  the  missile  and  A^  represent¬ 
ing  the  normal  acceleration,  the  acceleration  of  the  center  of  mass  of  the  pallet 
can  be  expressed  as  follows  (figs.  A-1  and  A-2): 

^cp  ”  '^cp  *1'^)  sin  [4/  +  4)^)  j'] 

+  4'  [-sin  (4  +  4^)  i cos  (4  +  4^)  j”] 

A  coordinate  transformation  is  necessary  to  express  and  A^^  In  the  primed 
coordinate  system 

V  *  V*  \ 

A^T  -  -  cos  bJ'  +  A^  sin  gj'  (A-3) 

With  the  above  acceleration  expression  and  the  free  body  diagram  of  figure  A~2, 
Newton's  Law  can  be  written  as  follows: 


P  n  -  p.s,  P  n,  +  F'  1'  -  w.s,  F  j'  +  u.s^  F  '  J ' 
nn  I4nt  xp  15  yp"^  15  xp-* 

=  •"p  {-  cos  6^)  I'  +  (a^  sin  6^  -  cos  6^)  j' 


-  4^  [cos  [4  +  4^  )  i'  +  sin  [4  +  4^.  ,  j'] 

+  4  [-  sin  (4  +  4^)  i'  +  cos  [4  +  4^)  J' 


(A-4) 


The  slgnum  functions  Introduced  here,  S4  and  S5,  assure  proper  direction  of  the 
friction  forces  at  the  escape  wheel-pallet  Interface  as  well  as  at  the  pallet 
shaft,  regardless  of  the  direction  of  pallet  rotation.  Thus, 


(A-5) 
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m  of  pallet  with  eccentric  center  of  mass 
system,  escape  wheel  shown  for  reference  i 


(reference  2,  eq  B-1).  The  unit  vectors  and  n^  are  adapted  from  equations  A-I 
and  A-2  of  reference  l. 

The  moment  equation  of  the  pallet  must  be  vrrltten  with  respect  to  the  accel¬ 
erated  pivot  Op,  l.e., 


where 


(A-7) 


-  -  1*  X  ra  r  +  H- 
0  0  p  cp 

P  P  P 


M  ^  sum  of  all  external  moments  with  respect  to  pivot  Op 
P 


Tq  ”  absolute  acceleration  of  point  Op 
P 


H  ■  time  rate  of  change  angular  momentum  of  the  pallet  with  respect 
p  to  point  Op 

With  the  acceleration  of  the  missile  or  rocket  expressed  in  terras  of  axial 
and  normal  acceleration,  equation  A-7  takes  the  form: 


=■  A^  (sin  0^  i"  +  cos  6^  i')  +  A^^  (cos  6^  1'  -  sin  j '  ] 

P 

xm  r  (cos(-^+4')l'+slnCi;;+4))j'^+l  yk  r . 
p  cp  c  c  p  (A-H> 

Appropriate  computations  and  substitution  of  all  moments,  according  to  fig¬ 
ure  A-2,  results  In  the  final  scalar  moment  equation  (the  moment  arms  Aj ,  Bj ,  Cj , 
and  Dj  of  reference  2  are  now  primed): 


Pn  (Of  +  -t 


I  +  m  r  [a  (sin  ('^  +  'J'  )  sin  6,  -  cos  (ij;  +  'p  }  cos  6  ] 
p  p  cp  A  r  u  n  u 


+  A^  (sin  (i|/  +  ]  cos  6^  +  cos  ('!»  +  <P^  )  sin  ]  ] 


(A-9) 


where 


D,"  =  C  cos  (.  P  -  a  -  \|^) 


(A-10) 


C'  *=  -[r  +  C  sin  (0  -  a  ~  'l')l 


(A-11) 


As  in  reference  3,  F  and  F  represent  conservatively  evaluated  pivot  force 

xp  yp 

components  which  assure  that  the  pivot  friction  moments  are  opposed  to  the  rota¬ 
tion  at  all  times.  The  following  illustrates  how  this  goal  may  be  accomplished. 

The  pivot  force  components  and  F'^  must  first  be  obtained  from  component 

expressions  of  the  equation  developed  using  Newton's  law  (eq  A-4).  The  component 
expressions  are  as  follows: 

-  P  sin  ( ;|)  -  a)  -  p,  s,  P  cos  (()i  -  a)  +  F'  -  p.s.  F' 
n  1  4  n  xp  1  5  yp 

=  m  '-A.,  cos  6,  -  A  sin  S,  -  ^  r  cos  [4'  C*  ) 
p  "  N  4  A  4  cp  ^  c.' 


+  4'  r  sin  (4  +  4  j 
cp  ^  c 


(A-12) 


and 


P  cos  ( 4  -  a)  -  p  s,  P  sin  ( 4  -  a)  +  F'  +  p, s  F' 
n  1  4  n  yp  1  5  xp 

=  m  [a.,  sin  3,  -  A,  cos  0,  -  4»^  r  sin  (4  +  4  ] 
p^N  4  A  4’^cp 


+  4  r^p  cos  (4  +  4^ )i 


(A-n) 


The  pivot  force  components  F'^  and  F^^  are  found  through  simultaneous  solu¬ 
tion  of  the  above  component  expressions.  Subsequently,  they  are  approximated  as 

F  and  F  ,  respectively.  The  resulting  expressions  for  F  and  F  are  given 
xp  yp  xp  yp 

as: 


F  =  A  P  X  A  A  ±  A,A,.  ±  A  4  ±  A  4 
yp  In  2  A  3  rJ  4  5 


’^xp  =  "e^’n  ^  \  ^  ^  ^0 


(A-14) 

(A-15) 


where 


pj  (s^  -  s^]  sin  (  4  -  a)  -  (1  +  ^4^5)  cos  (4-01) 


I  +  P, 


fcos  S,  -  p,  s,  sin  0,  ) 
4  I  n  it  ' 


(A-16) 


(A-17) 


(A-18) 
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t 


[)s  ^  J-aIn  (4»  +  ]! 

I  + 

In  (i|;  +  »J/  )  +  COB  f C  ^  '*1 
c  '  i'  '  ‘ 

-TTT7  - 

2 

i)S  (  il  -  ft)  +  (l  +8,55,  u,  1  sin  (  (}|  -  ft)  I 


(A-19) 


(A-’O) 


cos  P,  +  a  sin  0 


sin  6,  +  m 


cos  +  <J|  ) 


I  +  U. 


^cp  [sin  ('I'  +  -  UjS^  cos  (•>  + 


To  make  the  final  decision  concerning  the  signs  of  equations  A-14  and  A-15, 
these  forces  are  substituted  into  the  moment  equation  (A-9),  and  the  influence  of 
the  direction  of  rotation  on  each  of  the  resulting  moment  computations  is  ex¬ 
plored: 

''n  I”l'  *  S'  “l’4  ■  <*1  *  *6)1  *  %“l"-  *A  (*2  *  ^) 

*  N  <*3  *  ‘a)  *  (*4  *  *,)  i  -p-l's  ♦  1*5  *  *10-’ 

“  ""p  ’^cp  J  6,  ) 


+  Aj^  (sin  (ij3  +  1  cos  6^  +  cos  [ip  +  )  sin  )  ] 


(A-26) 


In  order  for  the  friction  moments  to  appropriately  oppose  the  motion,  the 
following  slgnum  assignments  are  made: 

With  85  positive  for  positive  rotation  (CCW)  and  vice  versa,  while  all 
other  parameters  are  positive  at  all  times,  the  following  moment  components  of 
equation  A-2h  must  have  negative  signs  during  positive  rotation: 


P  p  U,S-  (a,  +  A,  1 
n  p  1  5  '•  1  6 


(A-27) 


(a-28) 


The  axial  and  normal  acceleration  terms  and  Aj^  can  be  both  positive  and 
negative  due  to  varying  flight  patterns  and  decay  due  to  air  resistance.  This 
requires  tlie  introouction  of  signum  functions  and  s^.  These  signura  functions 
are  assigned  values  In  the  following  manner; 

s^  »  -1  for  positive 

»  +1  for  A^  negative 

=  -1  for  Aj^  positive 

S7  =  +1  for  A[^  negative 

With  the  introduction  of  and  s^,  the  following  moment  components  ot  equation 
A-26  must  have  positive  signs  during  positive  rotation: 


and 


■^*6  \  “p“lS 


The  choice  of  sign  for  the  friction  moment  i-'i  equation  A-2b,  which  is 

proportional  to  the  pallet  angular  acceleration  i};,  is  discussed  in  detail  in 
reference  ’  ,  appendix  F.  That  work  results  in  the  computational  rules  of  equa¬ 
tions  A-36  and  A-37,  which  deal  with  the  sign  of  the  effective  moment  of  inertia 
Ipj^  of  the  pallet.  (Note  that  the  signum  function  s^  has  now  been  omitted.) 

With  these  sign  considerations,  the  moment  equation  A-26  becomes; 

^l  >'n  "  N2 

■  ‘pK  *  ”p  'cp  “4  ■  ““  “4! 

+  A.  [sin  cos  A  -  cos  (')^  +  iji  )  sin  B,  )1 

>i  c  4  c  4-' 


(A-31) 


where 


All  =  +  s'  "is  '  ppss  ^ 

S2  =  SS^l"5  ^'"2  ^ 

Ai3  =  SSSS  ^"^3 

Ai4  =  PpSS  ^ 

•  ** 

^  when  47  and  i|)  have  the  same  signs 
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(A-37) 


^PR  “  ~  ^15  'J'  opposite  sii^ns''  ^ 

^15  “  (^5  +  A^g)  iA-3B) 

Equation  A-31  can  now  be  rearranged  in  order  to  yield  an  expression  tor  Che 
contact  force  ,  This  contact  force  is  to  be  the  common  force  in  the  develop¬ 
ment  of  the  dynamics  of  the  escape  wheel.  This  expression  will  later  be  used  to 
establish  a  single  differential  equation  for  the  escapement  in  coupled  motion. 
Solving  A-31  for  P^, 


1 

^^PR 

^  + 

\4  ' 

^2 

A  - 

A 

N3 

r 

cp 

din 

(4,  +  4,^  ) 

sin 

%  - 

COS 

( I'  + 

(sin 

('K  + 

)  cos  \ 

-  cos 

{4,  + 

'^C- 

)  sin 

tion 

can 

be 

rewritten 

in 

terras 

of 

esc; 

and  As  in  references  1  and  2, 
'll  *  U $  +  V4i 
and 

4i  = 


I  A- 39) 


(A- AO) 


(A-Al) 


Substituting  In  equation  A-39,  Che  expressioii  for  the  contact  force  In  terms 
of  the  escape  wheel  variables  is: 

■■n  ■  hpR  (A„  V)  -  A, 2  A,  -  A^ 

+  ra  r  [a  fsin  f  i|<  +  ]  sin  6,  -  coe  ( it  +  il  1  cos  0,  1 

p  cp  A  ^  ^  c  4  ^  c '  4  ^ 


+  (sin  (ij)  +  )  cos  6^  +  cos  ( <|/  +  ij;  ]  sin  ]  ]  ) 


(A-42) 


Care  must  be  taken  that  Ip  -  Aj^  does  not  become  negative.  If  this  occurs, 
Ipp  must  be  set  equal  to  zero.  For  free  motion,  Ipp  cannot  be  zero  since  it 
would  make  the  values  of  a'  indefinite  In  the  Runge-Kurca  solution. 
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Dynanics  of  the  Escape  Wheel  lo  Coupled  Hotioa  (Escape  Wheel  Incorporates  Pinion 
No.  4) 

A  free  body  diagram  of  the  escape  wheel  and  pinion  no.  4  is  shown  in  figure 
A-3.  The  pivot  forces  and  Fy^  as  well  as  the  forces  ^nd 

are  now  defined  in  the  general  (unprimed)  x-y  system.  The  unit  vectors  n^  and 
must  now  be  expressed  In  terms  of  the  general  coordinate  system.  From  equations 
A-1  and  A-2  of  reference  2: 

n  =  cos  ( 4  -  o)  i"  +  sin  {(Ji  -  a)  j  "  (A— 43) 

t 

n  =  -  sin  ( iji  -  a)  i'  +  cos  (ip  -  a)  2'  (A— 44) 

n 

Equations  A-55  and  A-56  of  reference  1 

1'  ■=  -  cos  e,  i  -  sin  e  J  (A-45) 

4  4 

i  '  =  sin  6  i  -  cos  6,  3  (A-46) 

"44 

can  be  used  to  perforin  the  transformation.  The  resulting  equations  are 

tA-47) 


lA-4») 

The  expressions  for  the  unit  vectors  n,  and  n  ,  as  used  in  the  analysis 
of  pinion  no.  4  in  reference  3,  section  A-la  k\e  of  farther  interest, 


C  -  cos 


( <{>  -  a  +  )  i 


flin  (^  -  a  +  J 


and 


=  sin  {<!)“  a  +  6,  ) 


i  -  cos 


{(1  -  a  +  0^)  J 


n  =  sin 
34 


1^1 


®3^^ 


cos  (0  +  9  )  J 


(A-49) 


n  =  cos  f  0, 
N34  '  J 


9^  )  i  +  sin  (Bj  +  ^3)3 


(A-50) 


With  the  use  oC  those  unit,  vectors  and  thn  tree  bod>  diagram  (fig.  A-3),  the 
force  equation  for  counterclockwise  rotation  of  the  escape  wheel  assembly  as 
given  by  Newton's  law  is:^  ^ 


See  reference  1,  appendix  F  for  description  or  motion  reversal;  l.e,,  clock 
wise  escape  wheel  rotation.  This  may  oe.cur  after  severe  impact.?. 
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-  P  n  +  U,8  n  +  F  .  n  +  US  F  n  +  F  i  +  vi  F  i 
n  n  1  A  C  3A  34  3  34  N34  x4  y4 


+  ViF,j-F,j"ra,  (a.  j+A  i) 
*^x4-^  yA-'  4''A‘' 


(A-51) 


Note  chat  the  coefficient  of  friction  y  is  now  used  tor  all  pivots  and  t^ear 
tooth  contacts  of  the  remainder  of  the  mechanism  train, 

Using  figure  A~3,  the  moment  equation  oi  the  escape  wheel  for  counterclock¬ 
wise  rotation  can  be  written 


where 


-  P  (a;  +  B'  u,s,  )  -  up,  (f  ,  +  F  ,  )  +  r^^  F 

n  ^  1  114'^  4  ^  x4  yU'  b4 


34 


-  ys^  (d,  -  aj  F 


<k-bl) 


34 


b  cos  a  +  g 
b  sin  a 


CA-53) 

CA-54} 


The  escape  wheel  pivot  forces  F  and  F  are  derive  ’  in  the  same  manner  as 

x4  y4 

the  pallet  pivot  forces.  They  are  obtained  from  the  component  expressions  of 
equations  A-51;  l.e., 

-  p  sin  (41  -  a  +  6.  )  -  8,  y,  P  cos  [(j>  -  a  +  S,  1 
n  '  4  41n  '■  U' 


*  •l"  («3  ♦  *3)  *  "=3  fj,  '»>  («3  ♦  *3)  -  "4  \ 

*  ^4 


(A-55) 


P  cos  (<ti  -  a  +  6,  1  -  8,y,  P  sin  [b  -  a  +  B  1 
n  ^  4  4  1  n  ^  k' 

-  ^34  (»3  +  «j)  »'3  ‘•■34  ('3  “s*  ■  ’«  '‘a 

-  ■'y4  *  “  ^4  ■  " 


(A-5b) 


Simultaneous  solution  of  equations  A-35  and  A-56  yields 


F  ,  ”  A, ,  P  +  A,  -  F.  i  A  A  ±  A  „  A 
y4  16n  17  34  18A  19N 


1A-57J 


A- 4 

The  stgnum  functions  Sj ,  32,  and  Sj  are  defined  in  reterence  3 
with  the  tooth  contact  friction  of  various  meshes. 


in  connection 
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^  ^21  ^34  ^22  \ 

i;]  sin  (ij>  -  a  +  6^)  +  (l  + 


1  +  U 

-  y  (l  "  bln  (6^  +  6^)  -  (l  +  w^s^)  cos  (6^  +  6^^ 


1  +  1^1  W84  3^''  [<|)  -  a  +  6,  )  +  (s,y,  -  Pj  cos  [(J> 


1  +  P 


(1  +  u  Sj )  sin  (Bj  +  9^  )  +  p  ( 1  -  )  cos  [b^  +  0^) 


Noting  that  Aj^  »  A23  and  Ajq  -  A22»  equations  A-57  and  A-58  are  rewritten 
dropping  the  unnecessary  variables  A22  and  A23. 


V  ’  ^16  ^n  *  ^17  ^34  *  ^18  \  *  ^^19  \ 
^x4  ■  ^20  ^n  ^1  ^4  *  '^19  \  *  ^18  \ 


(A-67) 

(A-68) 


These  pivot  forces  are  now  substituted  into  the  raoraent  equation  A-58, 

-  K  *  'l'  *  *20)  ''n  "  i^7  *21)  ■'ji 

*  ^^18  *  *  ^*18  *19^  *  *^84  *^34 


Again,  care  must  be  taken  to  assure  that  the  pivot  triction  moment  opposes 
the  motion.  The  terms 


*  ^19  ^  \ 


and 


must  be  negative  tor  counterclockwise  rotation.  This  is  again  accomplished  with 
the  signum  functions  and  Sy  Thus,  the  two  above  terms  become 


*  =6  “"4  (''is  *  *19  )  \ 


and 


+  "O,  (Ajg  t  Aj, )  A.^ 


Now  equation  A-69  can  be  solved  for  the  contact  force 


-  1,  41  +  A,,  F.,,  +  A^,.  A.  +  A„,  Aj^ 


'22  34  23  A  “24 


•25 


where 


^22  “  >'b4  ■  ^  "  ‘'3^  ^  (^17 


^23  =  ^  n  ^^8  ^9) 


^24  =  «7  ^  ^^19^ 


^25  =  a;  ^  ^ 


(A-70) 


tA-71) 

tA-72) 

(A-73) 

CA-74) 


Coabined  Coupled  Motion  Ditterential  Equation  for  Escape  Wheel  and  Pallet 

Two  I’xpressions  have  now  been  developed  tor  the  contact  torce,  p^^,  between 
the  pallet  mut  escape  wheel.  by  equating  the  two  t:quattons  A-70  anJ  A-42,  a 
differencial  equation  of  the  coupled  motion  in  tAirms  of  the  escape  wheel  angle  4 
is  obtained. 


i*25  ‘m  "  *  Nl  **  (''25  *14  *  *25  ’>  ♦' 


1 

=  A 

A 

F 

+ 

[a 

A 

+  A 

A 

-  A  m  r 

1 

1  1 

22 

34 

11 

23 

12 

25  25  p  cp 

+ 

m  r 

cos 

(ip  + 

COS 

0,  ) 

> 

+ 

> 

25 

P 

cp 

4  ^ 

A  *  11  24 

- 

ra  r 

sin 

(4,  + 

'1'  ) 

cos 

6, 

-  A,,-  ra  r  CO 

25 

P 

cp 

c  ^ 

4 

25  p  cp 

4  '  N 

{A-7b) 


The  system  differential  equation  cannot  be  solved  until  the  contact  force 
is  knovm.  An  expression  can  be  developed  for  by  comblnlni;  the  .ippropri- 

ate  differential  equations  for  gear  and  pinion  numbers  2  and  3  and  the  rotor 
(gear  no.  1). 


■  UWM  •  '^’1 

1* 

Lu*  — • 


Dynamics  of  Rotor  (Gear  No.  1) 


A  free  body  diagram  of  the  rotor  is  shown  in  figure  A-4.  The  acceleration 
of  its  center  of  mass  is  given  by 

7  _.7..7  ;2_  f _ /.  ..n7 


A„  =  Aj+Al-J,  r,  fcos  (ij)  +  A  )  i 
CR  N  1  Cl  ^ 

+  Sin  (4)^^  J  j  ^  ‘“’l  ^^cl  ^“^Ic  ^  ^ 

+  cos  (4.^^  +  4'j)  j] 


(A-7b) 


It  is  desired  to  continue  to  express  motion  in  terras  of  escape  wheel  varia- 

«  ** 

bles ,  4,  4),  and  41.  This  is  accomplished  by  introducing  the  gear  ratio  wliich 

relates  the  motion;  i.e., 


where 


^  =  ‘\l  ^ 


_  "‘^PA  ^P3  ^F2 
‘'^G3  ^G2 


The  rotor  angle  4)^^  +  4*^  is  expressed  as  follows; 
^Ic  ^Ic  41  ^T 


(A-77) 

(A-7«) 

(A- 79) 

(A-80) 


where  4  represents  the  total  rotation  of  the  escape  wheel  from  the  inception  ot 
the  motion.  (The  section  on  Additional  Program  Features  describes  the  manner  in 
which  4^  is  obtained  as  a  function  of  the  instantaneous  angle  41.) 
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Equation  A-76  can  now  be  rewritten  as, 

=  A  j  +  A  i  -  (n,  ,  r  ,  fcos  f!|).  +  N  ,  if  )  i 

CR  A  N  '■  41  ‘  cl  '•  '■^Ic  A1 

+  Sin  [fj^  +  f.p)  j]  +  f  [-  sin  (f^^  +  f  )  1 

+  cos  f  f  +  N  fill 

''’^Ic  41  J  lA-81) 


With  figure  A-4,  Newton's  force  equation  can  now  be  written  tor  clockwise 
rotation  of  the  rotor. 


■  ''12  "u  ■  ''l2  "N12  ■  ■'xl^  ^  “  ^xl'l  ■  “  1-'  CR 


where 


"n12  “  ^®1  ^  i  (®1  +  SjJ  j 


(A-»3) 


CA-84) 


(ref  3,  eqs  A-78  and  A-79). 
Further,  in  figure  A- 3 


-  ''12  "12 


Ca-«5) 


F ,  =  -  us  F  n 

f21  I  12  N12 


(A-8b) 


(ref  3,  eqs  A-103  and  A-104), 


The  moment  equation  must  be  written  in  the  manner  ot  equation  A-7  with  re¬ 
spect  to  the  accelerated  point  O, •  The  pivot  friction  reactions  F  and  f  are 

1  xlyl 

treated  so  that  the  associated  friction  moments  retard  the  clockwise  rotation  ot 

the  rotor.  This  leads  to 

“bl  ''12  ''  •  >“1^  ‘u  “  *  "‘>1  (^xl  *  ^ 

=  -  (A;,  j  +  \  O  X  rai  rci  [cos  (f^^  +  f .j, )  i 

*  =1"  (q,:  *  “4,  q)  Jl  *  I,  "41  ♦  1  (4_a,, 

Performing  the  cross  product,  and  then  simplifying,  the  moment  equation  becomes: 


Description  of  motion  reversal,  reference  1,  appendix  F 


bl 


m 


1  '^cl  ^  \l  \  -  “l  ^  \l 


+  II  N^i  ^ 

The  force  equation  A-82  can  be  rewritten  as  two  component  expressions 
through  simultaneous  solution,  give  the  forces  p  ^  and  ? 

■  ^2  (“l  *  ®1>  ■  “h  "n  ®l)  -  ‘'xl  "  ‘'y, 


and 


=  m^ 

\ 

- 

O4, 

r 

cl 

cos 

(^c 

^  ^1 

4'x} 

-  N 

41 

r  ,  sin 
cl 

(^Ic  ^ 

*'^41 

SJ] 

CM 

COS 

^^®1 

+  9 

1 

)  -  hs^ 

‘'12 

sin 

(Bl  - 

=  mj 

■Ay 
^  A 

- 

(\l 

sin 

0,c 

‘■41 

*r) 

+  N, 

H 

1  ^ 

*^cl 

COS 

($lc 

\l 

■yi 


xl 


Simultaneous  solution  yields 


^yl  ~  *  '^26  ^2  ^  ^27  \  *  ^28  \  *  ^29  ^‘'^41  *  "^30  ^41  ^ 


where 


F  ,  =  ± 
xl 


^31  ^2  *  ^28  \  ^  ^7  \i  ^  ‘^32  ^‘'^41  ^  *^33 


41 


he 


(l  +  s^)  sin  (6^  +  ej  +  (u^s^  -  l)  cos  (g^  +  9^] 


(1  +  m") 


'27 


'23 


'29 


'30 


(1  ^  h  )| 

>1  |u  oos  (4.,^  +  +  sin 


N 

(A-88) 

which, 

(A-89) 

U-90) 

(A-yi) 

(A-92) 

iA-93) 

iA-94) 

fA-95) 

i2\-96) 

{^-97) 
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'31 


hi 


'33 


[l  -  y"Sj ]  sin  +  6^  }  +  u  [l  +  )  cos  (b^  +  0^ ] 


[I  +  U  1 

hi  "cl  ^l  '^c  ^  ^41 


(A-98) 


(A-99) 


(A-lOO) 


(1  ^  P  ) 

Equations  A-91  and  A-92  are  now  substituted  into  tbe  moment  equation  A-88, 


\\  \l  -  '“l*l  ’'l2  "  “"l  (  ^6  *  Sl>  ”12 

^27  *  *2ft^  *  ^^29  *  ^32^  ^^41 

■  "l  'cl  <^c  '  *1)  \ 

»41  ♦t'  Ai  ■'  '1  \l  ’•  (*-101) 


fA  ,  + 

A  „ 

'  27 

28 

A^^ 

)  N 

33 

41 

^  "cl 

sin 

!hc 

Again,  care  must  be  taken  to  assure  that  the  friction  moments  oppose  the 
motion;  i.e,,  are  positive  for  clockwise  rotation.  In  order  for  tMs  to  be  ^true, 
the  following  terms  must  be  positive: 


^"12  '^26 


+  A. 


29 


*32) 


and  the  following  must  be  negative; 


■  *6  ""1  \  (*27  ♦  *28  ' 

-  '7  “l  \l  (*27  ■*  *28' 


remembering  that  the  slgnum  functions  and  are  defined  In  such  a  way  that 
the  products  s^  X  A^  and  Sy  X  A[^  will  yield  a  negative  number. 


To  determine  the  sign  of  the  pivot  friction  moment  which  Is  proportional  to 

the  angular  acceleration  (}i  of  the  escape  wheel  In  equation  A-lOl,  the  ideas  pre¬ 
sented  in  reference  1,  appendix  F  are  used.  In  order  to  accomplish  this,  let  the 
coefficient  of  friction  u  of  this  term  become  absolute  so  that  it  ceases  to  serve 
as  a  directional  slgnum  function  in  the  sense  of  reference  1,  appendix  F,.  Fur¬ 
ther,  let  the  expression  be  changed,  for  the  time  being,  so  that  it  becomes  a 

function  of  the  rotor  angular  acceleration  <)>  .  With  the  above,  a  'n  the  sense 
of  equation  F-2,  reference  1,  appendix  F,  the  absolute  value  of  .  friction 
moment  may  be  expressed  as 
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”aa  °  I  ^3^  '*’1 

From  this  point  on,  one  may  use  the  reasoning  of  reference  I,  appendix  F  direct¬ 
ly,  keeping  in  mine  rhat  j  p|  ^^30  ^33^  't’l '  used  instead  of  A22 


and  i|),  respectively. 

As  in  the  four  cases  of  reference  I,  appendix  F,  the  effective  moment  of 


inertia  takes  two  forms: 


Ijl^  -  Ij  +  |p|  Pj  ^^30  ^  ^33)*  4>j  ^ud  .j)j  have  the  same  sign  (A~102) 


^1  '^30  ^  ^33  when  (fj  and  (}i^  have  opposite  signs  (A-103) 
The  moment  equation,  A-lOl,  gives  all  relevant  expressions  in  terms  of  the  escape 


wheel  variables  ^  and  <j).  Since  they  are  both  proportional  to  ij  and  ^  by  the 
identical  gear  ratio  N^j,  one  may  readily  extend  the  above  computational^  rule  to 
the  escape  wheel  variables. 


The  above  considerations  give  the  moment  equation  the  following  form: 


hz  !'bl  ■  ‘“fh  *  “h  (*26  *■  <*27  '  *28>  *7 


(*27  *2«'  *N  *  "h  (*29  *  *32)  "41^ 


”i  ''cl  <hc  ■"  "41  h)  *A  ■  "1  hi  (he  *  "41  ‘t)  N 


*  hi 


(A-104) 


Solving  for  Fp 


where : 


F,  , 

_  ^3h  ''a 

^  ^36 

A37 

^^41 

•12 

<>) 

N41 

4> 

1  2 

A 

34 

^34 

=  - 

MSia, 

■»■  MPj 

+  A3j) 

4^27  + 

*28  < 

4. 

’’cl 

COS 

\l 

'('3.  ] 

^^36 

=  s^MPj 

IS7  ^ 

'^28  ^ 

-  mj 

'^cl 

sin 

O3.  J 

A37 

=  -  WO, 

A3  2  ; 

(A-105) 


(A-106) 

(A-107) 

(A-108) 


\  < 


V-'!* 


Me. 


(A-109) 


Dynaalca  of  Gear  and  Pinion  Set  No.  3 


The  equations  for  force  and  moment  equilibrium  on  and  about  pinion 

set  no.  3  are  developed  similarly  to  the  work  sliown  in  reference  3,  pp  A^7  -  A32. 
in  tills  case,  however,  the  inertia  force  T-j  is  omitted  and  replaced  with 
+  Lettlnti 


^3  =  ^43 


with 


-N 


P4 


'43 


G3 


the  force  and  moment  equilibrium  equations  are  as  follows: 


(A- no; 


Force  Equilibrium 


F  n  —  us  F  n  —  F  n  ~  us  F  n  +  F  i 
23  23  2  MOI  Tfi  9A  lA 


2  23  N23  34  34  3  34  n34  x3 


-  V  ‘  -  ‘,3  J  -  “  ‘x3  >  *  '*3  \  ‘ 


(A-UU) 


Moment  Equilibrium 


^3  ^"34  ■  ^4  "  ^3  ^ 


3  3  34  b3  23 


23 


+  UP3  (F^3  +  ?y3]  *  I3  N^3  4> 

The  force  equation  can  be  rewritten  in  component  form  as: 


iA-lllb) 


and 


-  F23  sin  [6^  -  0^)  +  us^  F23  cos  ^34  ^®3  *^3^ 

(A-112) 


u>3  cos  (63  *  83)  *  l.-^3  -  u  tyj  -  ..3  A,^  -  0 


x3 


^23  ^®2  “  ^2^  ‘'^2  ^  23  *-^2  ~  ®2  ^  ^34  '^®3  '^3^ 

-  SS3  F3^  sin  (63  +  93)  -  F^3  -  „  F^3  -  ,.3  A^^  -  0  ^^_3  333 
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Simultaneous  solution  of  equations  A-112  ana  A-113  yields  Che  following 
resvilts: 


where 


^y3  ■  ^  ^38  ^23  ^  ^39  \  ^  \o  \  ^  ^ 


34 


x3  42  23  40  A  39  A  43  34 


'38 


'39 


'40 


'41 


'42 


'4  3 


(l  + 


u  s„  cos 


(B,  -  0,  )  +  u  [s,  -  l)  sin  (B2  -  O2) 


1  +  u 


-un. 


1  +  u 


1  +  U 


(1  -  u'Sj) 

COS 

(63 

S' 

- 

U  ( 

1  +  S3) 

sin 

(83  + 

63) 

1 

+ 

2 

u 

2-1 
i 1  +  u  S2  J 

sin 

(62  - 

62) 

+ 

u  ( 

1  -  82) 

cos 

(^2  - 

®2) 

1 

+ 

2 

u 

(1  -  U“S3) 

sin 

(83  + 

S) 

+ 

w  [ 

1  +  S3} 

cos 

(63  + 

1  + 

2 

u 

(A-114) 

(A-115) 

(A-116) 

(A-117) 

(A-118) 

(A-119) 

(A-120) 

(A-121) 


The  moment  equation,  A-lllb,  can  now  be  rewritten  with  the  evaluated  friction 
terms.  Again,  the  signs  are  chosen  so  that  the  friction  forces  oppose  the  mo- 
t  ion . 

^h3  ''34  "  ‘"'3'’3  ’'34  "  ^^83  ^23  *  "®2  ^*^2  "  ^2'  ’'23 
^  ""3  ^^^8  ^  \2^  ^23  -  ®6  ^9  ^  \  ■  "7  ^^9  ^  \o  ^ 

^34  '^41  -^3  "  ^3  '^43 


Ttie  mom‘>iit  equation  can  now  be  solved  for  the  contact  force  F23: 


23 


^44  ^34  '^45  \  *  *^46  ‘^N  h  ^43  ^ 

\7 


(A-122) 


(A-123) 


50 


where 


■44  “ 

S3  -  ^ 

3^3  ^  "°3  ^ 

(A- 124) 

II 

- 

(A- 125) 

%6  ■ 

-  pd3S^ 

^^9  ^  ^AO-' 

(A-126) 

'A  7  “ 

"b3  - 

["2  ^  "3  ^8  ^2^J 

(A-127) 

Dynamics  of  Gear  and  Pinion  Set  Number  2 


The  moment  equation  of  gear  and  pinion  sot  number  1  is  developed  and  solved 
similarly  to  that  for  gear  and  pinion  set  number  3  by  replacing  Tn  with  in-,  [a  i 

—  i  *-  M 

+  A  j  1  in  reference  3  and  using  Che  free  body  diagram  in  reference  3,  page  A-3b. 
A 


and 


The  force  equation  is  divided  into  its  component  parts  and  solved  tor  y 

F  ^  with  ttie  following  results: 
y2 


^2  *  ‘\b  *"12*  \9  \  *  So  •\n  * 


51  ’'23 


‘'x2  ~  *  ^52  ^12  ^  So  ''a  *  \9  \  *  S3  ^23 


where 


'A  8 


p  (s^  -  1  )  sin  (6^  +  Oj  )  -  (u^Sj  +  1  )  cos  (;3^  +  6^} 


1  +  M 


A, 


'A  9 


^50 


'51 


'5  2 


'53 


ra„ 


1  +  P 
P  ra,. 


1  +  P 


( P  -  1  ]  cos  [ 


0^  ]  -  P  Cs^  +  1  ]  sin  ( 


2 

1 

+ 

u 

1 

P  (1 

1  -  Sj^  )  cos  (b^  +  ) 

- 

(1  + 

sin  (i3^  +  ej 

1 

2 

+ 

p 

(1  ■ 

-p8l3in^6  -0] 
2 '  '2  2^ 

- 

P  (1  + 

)  cos  (n^  -  0^) 

1  +  P 


(A-128) 

(A-129) 

iA-130) 

(A-13U 

iA-132) 

CA-133) 

U-13A) 

(,A-135-) 
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Again,  iT\  writing  the  moment  ef’uetion,  algnt;  are  chosen  and  slgnum  functions  are 
employed  to  ensure  that  the  frlv“'onal  forces  always  oppose  the  motion. 


where 


'23 


2  2  23 


F 

b2  12 


-  us^  (d^  -  aj 


12 


>48  "  S2  ^  ^2  ■■  "6  K9  ^  \  ^  No  ^  \ 


53;  ^23 


^2  42 


(A-136) 


«2  = 


(A-137) 


and 


\2  = 


Np4  Np^ 


N  N 
G3  G2 


(A-138) 


Finally,  equation  A-136  is  solved  for  Fj2  yielding 
F 


'^34  *"23 


^55  V  '*■  ^56  ^2  ^42 


12 


'37 


where 


A54 

=  \2  ^ 

2  '-^31 

+  A33j 

- 

A3  5 

=  ■■ 

(A49  + 

So ' 

A36 

-  -  PP2S, 

>49  ^ 

So  ^ 

A57 

= 

1  >l  ■ 

-  a^l  - 

"»2  <‘'48  *  *52 

(A-139) 

(A-140) 

(A-141) 

(A-142) 

(A-143) 


Dynamics  of  the  Combined  System  In  Coupled  Notion 


l'-(liiatlon  A-75  Is  the  differential  equation  of  coupled  motion  of  the  entire 
system  in  terms  of  the  escape  wheel  variable  4'.  In  order  to  solve  the  equation, 
an  expression  must  be  developed  for  the  contact  force  F34«  A  combination  of 
eq\iatlons  4-103  and  A-139  (both  expressions  for  the  contact  force  Fj2)  will  yield 
an  expression  for  the  contact  force  F23.  The  resulting  expression  for  F23  can  be 
i-ninblned  with  equation  A-123,  also  an  expression  for  F23.  This  will  lead  to  an 
expression  for  the  contact  fort:e  F34.  Combining  A-105  and  A-139  yields: 


'2^  S4  "34 


A,,  '•'^33  S?  ^34  Ns''  \  ^^6  S7  ~  '^3A  ^^36^  N 


+  '>37  S7  ^I'J  -  Sa  ^  <^1 


57  41  IR  34  2  42- 


(A-144) 


Now,  combining  this  equation  with  equation  A-123  results  in  ai\  expression  tor 


=  "I - ^ \7  ~  A.,  A,.  -  A.,,  A_  A,,  ] 

34  A,.,  A.,  Ac,  *•  33  4/  57  34  47  5:3  34  45  5^  A 

34  44  34 

^  ^^6  \7  ^7  "  ^4  \7  ^6  '  ^4  ^6  Na  ^  ''n 

■*■  '.'^37  \-j  ^54  ^41  )  *  *  (\7  ^57  ‘''41  *  '^34  ^54  ^3  •'^43 


^34  ^7  ^2  ^42^ 


iA-14S) 


Now  this  expression  tor  the  contact  force  K24  can  be  substituted  Into  equation  A- 
75  to  give  the  differential  equation  of  coupled  notion  of  the  systeio: 


where 


"58  ^  "  "59 


=  A^„  A.  +  A^,  A 
60  A  6 !  N 


"11  "2  2 

"58  ”  ^25  ^PR  ^  "11  ^4  “  k  A  A  ^"47  "57  ‘"41  hk 

34  44  54 


+  A,,  A  I  N,  ,  -  A,.  A.,  1.,  .N  .) 

34  54  J  43  34  47  2  42  ^ 


i  »  A  i  u2  *  A  T  u  "h  "22  "37  "47  "57  2 

\59  “  *^14  ^25  "25  ^PR  ^  "  Aj^  A^^  A^^  ^41 


(A-146) 


(A-147) 


U-1481 


^ 1 1  ^22 

A,,  A,  ,  A_  ^"35  "47  "57  "  ^34  \7  "55  "  "34  \b  "34^ 
34  44  34 

+  A,,  A^,  +  A,  k..  -  A„.  m  r  sin  ( ij;  +  ij;  )  sin  0 

11  23  12  25  2>  p  cp  ’^c  ^  4 

+  A„,  m  r  cos  ( +  il)  1  cos  8, 

25  p  cp  4 


iA-1497 


"li  "22 

'^34  ^^44  ‘’^54 


36  "47  "57  ^^34  "47  "56  “  S4  "46  "54^ 


+  A,  ,  A^,  +  A,  ^  A,  ^  -  A,.^  m  r  sin  ( ij;  +  ij,'  1  cos  B, 

1  1  24  13  25  25  p  cp  '■  c'  4 

-  A  m  r  cos  f’J/  +  6  I  sin  B, 

25  p  cp  c  '  4 


(A-150) 


53 


DIFFERENTIAL  EQUATIONS  FOR  FREE  NOTION  REGIME 


The  differential  equations  of  free  motion  of  both  the  pallet  and  the  escape 
wheel,  gear  and  pinion  no.  3,  gear  and  pinion  no.  2,  and  the  rotor  system  can  be 
developed  from  coupled  motion  expressions  previously  established. 


Free  Motion  of  the  Pallet 


Equation  A-39  is  an  expression  for  the  contact  force  between  the  pallet 
and  escape  wheel.  By  setting  equal  to  zero,  the  differential  equation  of  tree 
motion  of  the  pallet  is  obtained. 


A  li;  A 

62  ^  14  ^ 

II 

A  +  A  A 

A  64  N 

(A-151) 

_  T  A-6 

62  “  ^PR 

(A-152) 

■(S3  =  A,  „  -  m  r  (sin 
6  3  12  p  cp  ^ 

('t'  + 

i|(  1  sin  8,  -  cos 
c  4 

[  d(  +  4,^  )  cos  6^  ) 

(A-153) 

■AA  =  A,  ra  r  [sin 

64  13  p  cp'' 

(d/  +  4; 

'  ]  cos  8,  -  cos 
c'  -4 

(ip  +  (1^)  sin  S^) 

(A-154) 

Free  Motion  of  the  Escape  Wheel,  Gear  Train,  and  Rotor  System 


The  differential  equation  can  again  be  developed  in  this  case  by  first  al¬ 
lowing  the  contact  force  to  equal  zero.  This  is  done  in  the  escape  wheel 
expression  (eq  A-70)  yielding; 


I 


A 


34 


A^s  + 


A,/  A.^ 
24  w 


iA-155) 


Now  equation  A-145,  an  expression  for  the  contact  force  F34,  is  substituted  into 
equation  A-155,  resulting  in  the  desired  tree  motion  differential  equation: 


\5  '  ^  \6 


=  A  ,  A  +  A  „  A 
67  A  68  N 


whe  re 


22 


"  ^4  A^,  A,,  A 


“34  44  64 

■  Sa  \7  ^2  ■\2' 


7  ^\7  S7  \l  7k  "  " 


34  ^4  S  "43 


iA-156) 


(A-167) 


A-b 

For  tree  motion,  cannot  be  zero  since  it  would  make  the  value  of  i,'- 

Indefinite  in  tlie  Runge-Kutta  solution  (footnote  A-2). 
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'66 


22  37  47  57  41 

AAA 
34  44  54 


A22 


\.7  ^<17  “  ^•7/.  A  (A-159) 


"67  -  A,,  A,,  A,,  ^“35  “47  “57  “34  “47  “55  “34  “45  “54-'  “23' 

34  44  ^4 


Aio  =- - , - : -  (A-,  a.  ^  A  ,  -  A  A  A  -  A  A  A  ]  +  A  (A- 160) 

00  A^,  A,,  A,,  '■  36  47  57  34  47  36  34  46  54-^  24 

34  44  54 


Contact  Force  Expressions  for  Coupled  and  Free  Motions 


In  developing  differential  equations  to  model  the  sySLitii,  various  contact 
force  expressions  have  resulted.  These  contact  force  expressions  can  be  useful 
in  component  strength  calculations.  The  contact  forces  will  vary  according  to 
whether  the  escape  wheel  and  pallet  are  in  free  or  coupled  motion;  tlius ,  two  sets 
of  contact  force  expressions  are  shown  here. 


Coupled  Hot ion 


According  to  equation  A-145 


^34  \4  S4 


[(^35  ^47  Si  ~  ^34  ^kl  Ss  ■  Sk  ^5  ^4^  \ 


+  (a  ,  A,  _  A  —  A  A  -  A  ,  “  A  ,  A  A  )  A 
^  36  47  57  34  47  56  34  46  54^  N 


*  (*37  Si  *  i\7  ^7  %1  ^ 


IR 


^34  ^54  ^3  ‘'^43  ■  ^34  \7  ^2  '^42^ 


According  to  equation  A-123 


^44  ^34  ^45  \  ^Ub  S  ~  ^3  ^43 


23 


47 


According  to  equation  A-139 


Ac/  F  I'j  Acc  A.  +  Arc  A  +  1,,  N,  i{i 

54  23  55  A  56  w  2  42  ^ 


(A-161) 


(A-162) 


(A-163) 


The  contact  force  between  the  escape  wheel  and  pallet  may  be  expressed  in 
terms  of  either  the  escape  wheel  variable  (j)  or  the  pallet  variable  ip.  Therefore, 
according  to  equation  A-7n, 


^4  ^22  ^34  ^23  \  ^24 


(A-164) 


or  according  to  equation  A-39 


^n^;  °  Ajj  ^^'PR  ^14  “  ^^12  ^A  "  ^13 

+  m  r  Ta  (sin  ( il»  +  'J'  ]  sin  B,  -  cos  ( 'J'  +  4*  1  cos  0  ) 
p  cp  "  A  ^  ^  c'  4  '■  c  ^  4  ^ 

+  (sin  (4+4’^]  cos  6^  +  cos  (4'+  4'^)  sin  )  ] } 


(A-165) 


Free  Motion 


Here,  by  definltloti,  P^^  =  0.  The  contact  force  can  be  obtained  by 

taking  the  contact  force  expression  A-70  and  setting  Pj^  =  0 .  This  results  in  the 
following  equation: 


^23  \  ^  ^Ik 


(A-166) 


The  expressions  for  Fp^q  and  Fp|2  can  now  be  developed  by  replacing  with  Fp^^ 
and  F^-^  with  Fp2  ^  In  equations  A-162  and  A-163,  respectively. 


•'^44  '^F34  '*^45  *  ^46  N  ^3  ^43  ^ 

k,. 


(A-167) 


'^34  ''f23  '^35  ^k  ^56  ^2  ^42 


(A-168) 


Changes  in  Impact  Expressions 


T)ie  Impact  description  of  reference  2  basically  remains  unchanged;  however, 
MS  In  reference  I,  pp  7  2-73  ,  the  total  moment  of  Inertia  1«;70T  escape 

wheel  Is  Increased  by  tlie  inclusion  of  the  rotor  and  gear  train.  Therefore, 


^STOT  "  ^4  ’3  ^43  ^2  ^42  "^41 


(A- 1 69) 


where 

=  escape  wheel  -  pinion  no.  4  moment  ot  Inertia 
=  gear  and  pinion  set  no.  3  moment  of  inertia 
I2  =  gear  and  pinion  set  no.  2  moment  of  inertia 
Ij  =  rotor  moment  of  inertia 

See  equations  A-79,  A-110,  and  A-138,  for  the  gear  ratios. 
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170  PROCRftn  niSLSfiC INPUT. OUTPUT, TAPes.iNPUT.TAPES'OUTPUT) 

180  COnnON  ft.B,C,R,PLPHR.PI.Z2,Hl,ne,N3,ri4,nP,Ii,12,I3,H,lP,EREST,LPt1 

190  lIDfi.DELT.^.  PHI  TOT,  PH  1PR,N41,N42,N43.  ONEGA.  0112, RCl,  PHI  1C.  TESTl,TESTe 

200  £,TE5T3,NG1 ,NG2,NC3.NP2.NP3,NP4.CAPRB1.CAPRB2,CAPRB3,RB2,RB3,RB^,TH 

210  3ETA1  .ThETA2.ThETA3.R1.R2,R3,R4.R5.RH01 ,RH02,RH03,RH04.RM0P. Jl, J2,J 

220  43.BETai.EETP2.BETA3.BETA4.D1,D2.D3.AL1IN,AL1FIN,J,TANG,MT, 

230  6AL21N.AL2FIN.AU31N.AL3FlN,ALPHAl.ALPHA2,ALPHA3,IN,T2.T3,T4,nu.nui, 

240  7RCP.PSlC.Sl.S2.S3.S4.SS.Al,A2,A3,0PHl2.DPSI2,F34nAX,F23nAX,Fl2riAX, 

2S0  8FF34nAX.FF23l1AX,FF12nAX.PNt1rtX.PHlCUTD.AA,AN.S6,S7 

2S0  OONnOM  /^ETA'  PSl . T in£ .0, DPSI . CP 

270  CONnON.-GCl'^  Tin(100).GA(l00).GL(t00).N 

280  DIMENSION  AUX(8.2).  AUX2(8.4).  PRPITIS),  PH1(2),  DPHH2).  X(4),  DX( 

290  14) 

300  REAL  Ml,Na,ri3.n4.t1P.n,I2.I3.I4.IP,LAI1BDA.K.N41.N42.N43.Jl.J2,J3,N 

310  lGl.NGa,NG3,NPa,NP3.NP4.f1U.nUl 

320  external  FCT.OUTP.FCTP.OUTPF 

330  C 

340  C  READ  IN  and  URITE  DATA 

350  C 

360  UR1TE(6.300) 

370  300  FORflAT  CESCAPEMENT  DATA*///) 

380  REaDiS, 22)0, B.C.R, ALPHA 

390  IIR:te<6,23»  a.B.C.R.ALPHA 

400  READ<5.32)  BETAI.BETA2.BETA3.BETA4 

410  URITE(6,4i  j  BETA1.BETA2.BETA3,BETA4 

420  READ  (5,24)  EREST.LAfIBDA.  delta 

430  URITE  16,25)  EREST.LAfIBDA. DELTA 

440  URITE<6,301) 

450  301  FORHATf/// TIASS  PROPERTIES*///) 

460  READ  (5,26)  Nl,n2,n3.n4.f1P 

470  URITE  (6.27)  (11,(12, n3,n4,nP 

480  read  (S,26)  II, 12, 13, 14, ip 

490  URITE  (6.28)  11,12.13,14,12 

500  UPITE(6,302) 

510  302  FOftnAT(///*niSCELLANEOUS  PARAMETERS*/// > 

520  READ  (5.29)  RCl.RCP.RMOP.PHIlC.PSlCCD.PHlD.PHlCUTO.MU.flUl 

530  URI'E  (6.30)  RCI.RCP.RHOP.PHIIC.PSICCO.PHID.PHICUTD.IIU.IIUI 

540  URITE(6,303) 

550  303  FORnAT(///*GEAR  PARANETER5*/// ) 

560  READ  (5,31)  PSUBDl ,PSUBD2,PSUBD3.NC1,NC2,NC3,NP2,NP3,NP4,CAPPP1 ,CA 

570  1PPP2 , C APRP3 , RP2 , RP3 , RP4 , THETAl , THETA2 , THETA3 

580  URITE  (6,35)  PSUBDl , PSUBD2,PSUB03, NCI ,NC2.NG3,NP2,NP3,NP4,CAPRP1 ,C 

590  1 APRP2 , C APRP3 . RP2 . RP  3 , RP4 , THE  TAl , THETA2 , THE  T A3 

600  READ  (5,32)  RHOl . RH02,RH03,RH04 

610  URITE  (6,37)  RH01,RH02,RH03.RH04 

620  read  (5,33)  CaPR81.CAPR82,CAPRB3,RB2.RB3.RB4 

630  URITE  (6,38)  CAPRBl . CAPRB2.CAPRB3.RB2,RB3,RB4 

640  READ  (5,33)  CAPROl ,CAPR02,CAPR03,R02,R03.R04 

650  URITE  (6,39)  CAPROl ,CAPR02,CAPR03,R02.R03,R04 

660  read  (5,34)  Jl,J2,J3 

670  URITE  (6,40)  Jl,J2.J3 

680  URITE(6,304) 

690  304  F0R(1AT(/// ‘ANCLE  INDEXING  PARAMETERS*///) 

700  READ (5, 89)  TANQ.NT 

710  URITE(6,90)  TANG, NT 

720  UR1TE(6,305) 
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730  305  FORnATC^/-/" ACCELERATION  PROFILE  DATAV//> 

740  89  FORMAT  (F10.3.I3) 

750  90  FORMAT  (3X,*TANG  •  * .F10.3,3X, “NT  •  *,13/) 

760  READ  (5.91)  N 

770  91  FORMAT! 13) 

780  READ  (S,92)(Tin(J).SA(J),CL(J).J*l.N) 

790  92  format  (3F10.3) 

800  URITE  (6,93)  ( TIM ( J  )  .GA( J ) .CL( J >. J*1,N ) 

810  93  FORMAT  (Fl0.a,4X.FlO.2. 4X.F10.2^ > 

820  URITE  (6.94) 

830  94  FORMATt/^.'///  ) 

840  C 
850  C 

860  C  INITIALIZATION  OF  PARAMETERS  AND  CONOERSION  TO  RADIANS 

870  C 
880  C 

£90  J-0 

900  Tin£*0. 

910  PHI7OT»0. 

920  FHIPR-PHID 

930  DPHI2-0. 

940  OPSI2-0. 

9S0  F34MAX-0. 

960  F23MAX.0. 

570  F12MAX.0. 

980  FF34MAX'0. 

990  FF23MAX>0. 

1000  FFianAx^e. 

1010  PNMAX-0. 

1020  PI-3.141S9 

1030  ZZ'PIxlSO. 

1040  PHIlC-PHllCtZZ 

1050  P?ICC*PSICCD*2Z 

1060  PSIC'PSICC 

1070  ALPHR*ALPHAt2Z 

1080  C 

1090  C  COMPUTATION  OF  GEAR  RATIOS 

1 100  C 

1110  N41*-NP2»NP3*NP4/(NCUNG2»NG3) 

1120  N42.NP3*NP4/(NG2ING3) 

1130  N43*-NP4/'NG3 

1140  C 

1150  C  CONOERSION  OF  PRESSURE  ANGLES  TO  RADIANS 

1160  C 

1170  THETAI-THETAUZZ 

1180  TMETA2-TMETA2I2Z 

1190  THETA3-THETA3*ZZ 

1 0 

1210  c  determination  of  gear  train  constants 

1220  C 

1230  TEST1*TAN(THETA1  ) 

1240  TEST2-TAN(THETA2) 

1250  TEST3*TAN(TMETA3) 

1260  01*(CAPRB14RI2)ITAN(THCTAt) 
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.'  •  .'*  i.  *  V  «-!>  u  »ui 


".V'JTJ  *J)*J  *.«.TJtr>7J»..'gJiy^?gJg-r5»."y’.T.’irv»V^»'t  w-/>r*rTC’Tk' 


1890  C 

i3«e  c 

1319  C 

13S9 

1339 

1349 

1359  C 

1369  C 

1379  C 

1389 

1399 

1499 

1419  C 

1429  C 

1430  C 
1449 
1459 
1469 
1479 
1489 
1499 
1599  C 
1519  C 
1529  C 
1539 
1649 
1559 
1569 
1579 
1689 
1699 
1699 
1619 
1629  C 
1639  C 
1649  C 
1659 
1669 
1679 
1689 
1699 
1799 
1719 
1729 
1739 
1749 
1759 
1769 
1779 
1789  C 
1799  C 
1899  C 


D2«  ( CAPRB2-)^RB3  >«TAN(  THETA2  ) 

D3«(CAPRB3+RB4)*TAN(THETA3» 

determination  op  earliest  and  latest  possible  values  op  alphas 

CALL  ALPA  (CAPRBl.RB2.THETAt.CAPR01.ft02.ALl  IN. ALIFIN) 

CALL  ALFA  ( CAPRB2.RB3.THETA2.CAPR02.R03.AL2IN. AL2FIN ) 

CALL  ALFA  (CAPR83,RB4.THETA3.CAPR03.ft04,AL3IN,AL3FIN) 

initialization  of  alphas 

ALPHA1-AL1IN+(AL1FIN-AL1IN)»J1 

ALPHA2'ALEIN+(AL2FIN-AL2IN)»J2 

ALFHA3-AL3IN+iAL3F1N-AL31N)»J3 

data  POR  RUNGE  ICUTTA 

PRnT(2)M0. 

PRnTv4 )• .01 

NDIM.2 

N0IMa*4 

PMKl  )*PHIDI22 
PHl(2)*0. 

COUPLED  MOTION 

1  PRnT(  1  ).TIf1E 
PftflTO).  .0091 
DPMKl  )‘.5 
0PHI(2»-.S 

IF  (PHlTOT.GT.3e..ANO.PHITOT.LT.(PHICUTD-30. ))  CO  TO  2 
URITE  (6.42) 

2  CALL  RICGS  (PRriT.PHI.DPHI.NOlM.lHLF.FCT.OUTP.AUX) 

IF  (PRnT(5  I.eo.  1.  )  GO  TO  21 

IP  (PhITOT.OE.PHKUTD)  CO  TO  21 

TEST  FOR  entrance  0»  EXIT  ACTION 

IF  (G.LE.0. )  CO  TO  6 
PHID-PHK  1  )‘'ZZ 
IF  (PHID.LE.TANG)  CO  TO  3 
GO  TO  4 

3  PHI< 1  )*PHI( 1 )*DELTA*Z2tNT 
PHIPR»PHI(1 )^ZZ 
PSI*PSI«2.«PI-LAnBDA*22 
PSIC«PSICC*LAnBDA»Z2 

GO  TO  5 

4  PHld  I'PHKn-DELTAlZZtCNT*!.  ) 

PHIPR*PHI(1 )/Z2 

PSl'P5I-2.tPl4^LAn8DAtZZ 

PSJC*PSICC 

FREE  MOTION 
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< 


1810 
1880 
1330 
1840 
1850 
1860 
1870 
1880 
1890 
1900 
1910 
1980 
1930 
1940 
1950 
1960 
1970 
1980 
1990 
8000 
8010 
£080 
8030 
8040 
8050 
8060 
8070 
8080 
8v90 
£100 
8110 
£180 
8130 
8140 
8150 
8160 
8170 
8180 
8190 
8800 
8810  C 
8880  C 
£830  C 
8840  C 
8850  C 
8850 
£870 
8280 
8290 
8300 
8310 
8380  C 
8330  C 
8340  C 
8350 


5  PRrtTt  1  )-TI(1E 
x(  1  )-PHn  1 ) 

X(8 '-PHI (8  ) 

X(3)-PSI 
X(4 )«JP6I 
DX(1  )-.85 
DX<8)«.85 
DXO)*  .85 
DX(4)*.85 
PRI1Ti3)-.0C01 

IF  (PHITOT.GT.30. .0MD.PHlTOT.LT.(PHlCUTO-30.  )  )  GO  TO  6 
URITE  (6,43) 

6  CALL  RKGS  (PRnT,X.DX.NDIf18, 1HLF,FCTF.OUTPF.0UX8) 

IF  (PHITOT.GE.PHICUTD)  CO  TO  81 

PHI  ( 1  )*X(  1  ) 

PHl(8)*X(8 ) 

H-8.»(BtC0S(ALPHR)4AtC0S(PHl (1 )-ALPHR)) 

<.A*A>B*B»R*R-C*C*a.»B»R«SIH<ALPHR)+8.»01B*COS<PHI<l  )  )-a.»A»R»SlH( 
IPHK  1  )-ALPHR) 

GOHE*  (  -H+S0RT(H»H-4.»IC  )  )/8. 

GTU0*( -H-SQRT( HtH-4.tr )  )/8. 

IF  ( ABS(G0NE ).LT.ABS(GTU0)  )  GO  TO  7 

G-GTUO 

GO  TO  8 

7  G*G0NE 

8  PHID«PH1  (  I  )/ZZ 

IF  (GP.LT.0.  )  CO  TO  11 
IF  <PhID.L£.TANG)  go  to  9 
GO  TO  10 

9  PHld  )«PHI(1  )4DELTAt2ZtNT 
PHIPR»PHI C 1  )/22 

PS  I -PS  I ♦£ . IPI -LAdBOAtZZ 
PSlC*PSlCC4LAnB0At22 
GO  TO  S 

10  PH1( 1 )«PHI( 1 )-D£LTAt22»(NT*l . ) 

PHIPR'PMK  1  )/22 

PSI*PSI-8.tPI+LAnB0At22 

PSIC*PSICC 

GO  TO  5 

11  IF  (PhID.LE.TAMG)  GO  TO  13 
EXIT  ACTION 

COnPUTATION  OF  OELOCITIES  VP  AND  VS  FOR  EXIT  ACTION 

AONE-B*COS( ALPHR  l^G 
DONE*CtCOS(OHl( 1  )-ALPHR-PSI > 

VP-DONEtDPSI 

VS*A0NEtPHI(8) 

IF  <PHITOT.CT.30. .AND.PHITOT.LT.(PHlCUTD-3e. ) )  CO  TO  18 
URITE  (6,44)  VP. VS 

EXIT  ACTION  TEST 

18  ir  (PHI(8>.GE.«..ANO.OP5I.GC.«.>  CO  TO  IS 


2369 
23?e 
2380 
2390 
2400 
24ie 
2436 
2430  C 
2440  C 
2450  C 
£460 
2470 
2480 
2^90 
2500 
2510 
2520  C 
2530  C 
2540  C 
2550 
2560 
2570 
2580 
2590 
2600 
2610 
2620 
2630  C 
2640  C 
2650  C 
2660 
2670 
2680 
2690 
2700 
2710 
2720 
2730 
2740 
27S0 
2760 
2770  C 
2780  C 
2790  C 
2800  C 
2810 
2820 
2830  C 
2840  C 
2850  C 
2860  C 
2870 
2880 
2890 
2900 
2910 


IF  (PhIC2).GE.0. .fiND.DPSI.LE.0. .AND.ABS(UP).CT.08SCyS>)  CO  TO  5 
IF  (PHl(a).GE.O..AND.OPSI.LE.0..AND.A8S<»JP).LT.ABStOS)>  CO  TO  l5 
IF  vPhI(2 1 .GE.0. .AND. OPSI .12.0. .AND. ABS(<;P ) .EO-ABSlOS) )  GO  TO  1 
IF  (PhI(21.LE.0..AND.DPSI.CE.0..AnD.ABS(UP).CT.ABS(VS))  GO  TO  15 
IF  (PhI(21.LE.0..ANO.CPSI  .GE.0..AND.ABS(UP).EQ.ABS(OS))  CO  TO  1 
IF  (PHlt2).LE.0..ANO.DPSI.CE.0..AND.ABS(yP).LT.ABScy5))  CO  TO  5 
IF  «PHI(2’.l.£.0..AhD.DPSI.LE.0.  )  CO  TO  5 

COfIPUTATION  OF  OELOCITIES  VP  AND  WS  F0»  ENTRANCE  ACTION 

13  AONE*B»COS< ALPHR)+G 

DONE*CfCOS(PHli 1 )-ALPHR-PSI ) 

uP*DCi-t£4DP5t 

y6«A0NE»PHI(2) 

IF  (PhITOT. GT. 30. .AND. PH1T0T.lt. (PHICUTD-30. >>  GO  TO  14 
URITE  (6,44)  UP. US 


ENTRANCE  ACTION 


14  IF  (PHI(2).GE.0..AND.OPSI.CE.0..AND.ABSrUP).GT.ABSCUS») 
IF  (PHI (2 ).GC.O. .AND.DPSI.GE.0..AND.ABS(UP).EO.ABS(US>) 
IF  iPHl(2  I.GE.O. .AND.DPSI.CE.0..AND.ABS(UP).LT.ABS(US)) 
IF  (PHl(2).Le.0..AND.OP5I.Ge.0.)  GO  TO  5 
IF  (Ph1(2).CE.0..ANO.OPSI.LE.0. )  GO  TO  15 
IF  iPHl(2).LE.0..AND.OPSl.LE.0..AND.A8S(UP).LT.ABStUS)> 
IF  (PHI(2).LE.0..AND.DPSI .LE.0.. AND. ABS( UP ).GT.ABS( US)) 
IF  (PhI>2 ).LE.0..AND.DPSl.LE.e..AND.ABS(UP).EO.ABS(US)) 


CO 

TO 

5 

GO 

TO 

1 

GO 

TO 

15 

GO 

TO 

5 

CO 

TO 

15 

GO 

TO 

1 

I  (IP  ACT 

15  CALL  INPACT  (PHKl  ),PH1(2),PS1,DPS1  > 

H*2.l(BtC0S(ALPHR)+AtC0S<PHI( I  )-ALPHR) ) 

K*Aite+Btl2*R»t2-C»»2*2.»B*R»SIN(ALPHR)T2.*A«BtC0SlPHltl  ))*2.IAIR$ 
ISINCPhK 1 I-ALPHR) 

G0NE»(-H*SQRT(H*|2-4.»IC )  )/2. 

CTU0*(-H-S(3RT(H»ia-4.*<))/2. 

IF  (AB5(C0NE).LT,ABS(GTU0))  CO  TO  16 

C'CTUO 

CO  TO  17 

16  G'GONE 

17  continue 


TEST  FOR  EXIT  ACTION 

PHID«PHI ( I )^ZZ 
IF  (PHID.LE.TANC)  go  to  19 

EXIT  action 

computation  of  uelocities  up  and  us  for  bottom  action 

A0NE>BSC0S( ALPHA )4G 
DOHE*C*COS(PHI< I )-ALPMR-PSI  ) 

UP»00N£«DPS1 

U$«A0Ne«PHI(2) 

IF  (PHITOT.CT.30. .AND.PHITOT.lt. (PMICUTD-30. >J  CO  TO  18 


2989  URlTi  (6,44)  UP, US 

2930  18  IF(«BS(UP-US).LT.l.e)  GO  TO  1 

2940  C 

29S0  C  EXIT  action  tests 

2960  C 

2970  IF  (PHl(2).GE.0..AND.OPSI.aE.0. >  CO  TO  1 

2930  IF  (PHI(2>.CE.0..ANC.DPSI.LE.0..0HD.ABS(UP).GT.ABS(US])  GO  TO  S 

2990  IF  (PHl<a) .GE.0. .AND.DPSt .LE.0. .AND.ABS(UP>.LT.ABS(US) )  CO  TO  1 

3000  IF  (PMl<a).LE.0..AND.DPSl.GT.0..AhD.ABS(yP).LT.ABS(US))  CO  TO  S 

3010  IF  (PHI(2).Le.0..AND.DPSI.GT.e..AND.ABS(UP).CT.ABS(yS))  GO  TO  1 

3020  IF  (PHI(2).LE.0..AnO.OPSI.LE.0.  )  CO  TO  5 

303C  C 

3040  C  COMPUTATION  OF  UELOCITIES  UP  AND  US  FOR  ENTRANCE  ACTION 
30Se  C 

3060  19  AONE-I>*COS(  ALPHA  )*C 

3070  D0NE-C»C0S(PHI(1 )-ALPHR-PSI  ) 

3080  UP- DONE *DPS I 

3090  Ub-AONEtPHI (2 ) 

3100  IF  (PHlTOT.GT.30..AND.PHITOT.LT.(PHiCUTD-30. ))  CO  TO  20 

3110  URITE  (6,44  I  UP, US 

3120  £0  lF(rtBS(UP-US).LT.l.0>  CO  TO  1 

3130  C 

3140  C  entrance  action  TESTS 

3150  C 

3160  IF  (PHl(2).GE.0..AND.DPSI.CE.to..AND.ABS(UP).CT.ABS(US))  GO  TO  5 

3170  IF  (PHI(2).GE.0..AND.DPS1.CE.0..AND.ABS(UP),LT,ABS1US))  CO  TO  1 

3180  IF  (PMl(a).UE.0..AND.t-PSI.CE.0.  )  GO  TO  5 

3190  IF  (FHl<a),GE.0..ANO.OPSI.LE.e.)  GO  TO  1 

3200  IF  (PHI(2>.Le.0..AfiD.DPSI.lE.0..AND.ABS(UP).CT.AlS<US))  CO  TO  1 

3210  IF  (PHl(a).L£.0..AND.DPSI.LE.0..ANO.ABS(UP).UT.ABS(US>)  CO  TO  5 

3220  21  URITE (6. 45 )F34MAX,Fa3nAX,F12nAX,FF34HAX,FF23nAX,FFl2nAX,PNI1AX 

3230  ATM-TIME 

3240  URITE(6,7S  l  ATM 

3250  75  FOPMATC  THE  S6A  ARMS  IN*, 2X,F6.3,2X, ‘SECONDS. • > 

3260  STOP 

3270  C 
3280  C 
3290  C 

3300  22  FORMAT  (5F10.5) 

3310  23  FORMAT  ' IH1.5X,2HA..F13.5.5X,2H8*,F13.5,SX,2HC»,F13.S,5X,2HR*,F13. 

3320  15,SX,6HALPHA*.F9.4/ ) 

3330  24  FORMAT  (3F10.S1 

3340  25  FORMAT  IIM  . SX.6MEREST* ,F5 . 2.3X.7HLAMBDA* ,F8 . 3, 3X.6HDELTA- .F8.3/ ) 

3350  26  FORMAT  <5£12.5) 

3360  27  FORMAT  (IH  .5X.4MM1  •.E15.5.3X.4Hne  •.E15.5,3X,4Mn3  • ,E15 .5. 3X,4Hn 

3370  14  •.El5.5,3X.4HnP  •,EIS.5/) 

3380  28  FORMAT  (IH  ,SX.4Mll  • ,E1S . 5 , 3X. 4HI2  •,£ 15 .5.3X. 4MI3  • .E15 .5. 3X,4Hl 

3390  14  •,E16.5,3X,4HIP  -.EIS.S^) 

3400  29  format  <6F10.4/3F10.4) 

3410  30  FORMAT  (GX.SHRCl  •  ,F7 . 4. 3X,5MRCP  -,F7.4. 3X,6M1»H0P  •.F7.4,3X. 

3420  13X,7HPHI1C  •,F9.4,3x,8HPSICCD  •.F9.4.3X,6HPH1D  •,F9.4//'6X. 

3430  29HPHICUTD  • .F6.0/^6X,4MMU  •.FS.S.SX.SHMUl  -.FS.!/) 

3440  31  FORMAT  <  3F  10 .4/6F  t0.8>'«Fie.  S-'SFlt.A  ) 

3450  32  FORMAT  (4F18,4) 

3469  33  FORMAT  (6F10.S) 

3470  34  FORMAT  (3F18.2) 


348e  35  FORpiaT  (1H  ,SX,8HPSUBD1  •,r5.1.3X.8HPSUBDa  •,FS.1,3X,8HPSUID3  ‘.FS 

3490  : . l^/6X,SHNCl  •,F4.0,3X.CHNCa  -.F^.e. 3X,5HNC3  •,F4.#,3X,5HNPa  ’.FA, 

3500  S0.3X,5HNP3  • . F4 .0, 3X,5HNP4  -.F4.0//6X.8HCAPRP1  • .F8.5, 3X. SHCPPRPa 

3510  3*,F8.S.3X.8HCAPfiP3  •.F8.5>'^6X,SHRPe  •  .F8 .5, 3X ,5M9P3  •  .F8.5, 3X,5HRP 

3520  44  •,F8.S/-bX,8HTHETAl  -.FB . 3. 3X. 8HTHETA2  ■,F8.3,3X,8HThETA3  •,F8.3 

3530  5/^) 

3540  37  rORHAT  C6X.6HRH01  -.FT.S.ax.BHRHOa  •,F7.5,3X,6HRH03  ■ .F7.S. 3X, 6HRH 

3550  104  •,F7.5-'> 

3560  30  FORMAT  (CX.SHCAPRBl  • ,F7.5. 3X.8MCAPRBa  -.F? . 5, 3X.8HCAPRI3  •.FT.S.l 

3570  lX.SHRBa  •.F7.S,3X,5HRB3  •,F7.5.3X,S'4RB4  -,F7.S/') 

3580  39  format  (6X,8HCAPR0l  • .F7.5. 3X, SMCAPROe  • , F7. 5, 3X,8HCAPR03  •,F7.5,3 

3590  lX.SHROa  •.F7.S,3X,5HR03  •,F7.5.3X,5HR04  •,F7.5/) 

3600  40  FORMAT  (1H0.5X,4HJI  • ,F4 . 2, 3X, 4HJ2  - , F4 . 2 , 3X, 4HJ3  -.FA.Z/i 

3610  41  FORMAT  (6X,8HBETA1D  •.F7,a.3X,8HBETAaD  •.F7.2,3X,8HBETA3D  -.FT. 2. 3 

3620  1X,9hBETA4D  •, 07.2/1 

3630  48  format  ( 1H0,5X. HHCOUPLEO  MOTION) 

3640  43  FORMAT  ( I H0 . SX, 1 IHFREE  MOTION//) 

3650  44  FORMAT  < 4H0UP- .F B . 3. 3X. 3Hys • .F3 . 3 1 

3660  45  format  ( lH0,6x.tF34MAX  •». F6. 2/180, 6X,tF23nAX  •»,F6.2/1H0.6X,»F12 

3670  U.AX  ■t,F6.a/lH0,6X,tFF34nAX  •t.F6.2/lH0.6X.»FFa3nAX  •*,F6. 2/180, 6X 

3680  ;.tFFl2MAX  •t,F6.a/lH0,6X,»PNnAX  •»,F6.2/) 

3690  END 

3700  SUBROUTINE  IMPACT  ( PHI , DPMI .PSl . t  1 

3710  COMMON  A,B,C,R.ALPMR.PI.22.ni.na.  .14,  MP ,  11 ,  la.  13 , 1 4 .  IP.  EREST ,  LAM 

3720  1 BDA, DELTA, Phi  TOT, PHIPR,N41.N42,N4J, OMEGA, OMa.RCl, PHI  10, TEST  1 ,TESTa 

3730  a,TeST3,N<;i,NG2.NG3,NP2,NP3.NP4,CAPR81.CAPRB2,CAPRB3.PBa,RB3,RB4,TH 

3740  3ETAl,THETAa,THETA3,Rl,Ra.R3,R4.R5.RH01.RH02,RH03,RH04.RH0P,Jl,J2,  J 

3750  43,BETai .BETAE, BETAS, BETA4, 01. D2,D3. ALII N.ALIF IN, J. TANG, NT, 

3760  6ALaiN.ALaFIN,AL3IH,AL3FIN.ALPHAl,ALPMA2,ALPNA3,]N,Ta,T3.T4,MU,MUl, 

3770  7RCP,PSIC,Sl,Sa,S3,S4,S5,Al,A2,A3,DPHI2,DPSI3,F34nAX,Fa3BAX,FianAX, 

3780  8FF34MAX,FF23MAX.FF12MAX,PNMAX,PHICUTD,AA.AN,S6,S7 

3790  REAL  I1,I2.13.I4.IP,LAMIDA.N41.N42.N43,IST0T,K 

3800  IST0T-14*ll»N41»N4t4iatN4aaN4a»13«N43tN43 

3810  H.2.»(B*C0S{ALPMR)*paCO5(PHI-ALPHR)) 

3820  •C‘Att2«'Eat24Rxya-CtS2*2.tB>RJSlN(ALPHR  l^B.SAtBICOSIPHl  )-2.>AtRtSlN 

3830  KPHI-ALPMR) 

3840  GONE  •  (  -H*SQRT  <  H»ia-4 . f  1C  1  )/2 . 

3850  GTUO'<-H-SORT(HII2-4.»IO)/2. 

3860  IF  'AB5(C0NE1.LT.ABS(CTU0))  CO  TO  1 

3870  G*GTWO 

3880  CO  TO  2 

3890  1  G'OONE 

3900  a  AONE*B*COS(ALPHR)*G 

3910  D0NE.C»CO5(PHI-ALPHR-PSI  1 

3920  DPHIIN-DPHI 

3930  OPHJ* ( lP»AONE»OPSI*ISTOTfDONEIDPHl4lP»AONEIEREST/DONC«(DP5I»DONE-D 

3940  IPHIFAONE ) )/( IP»AONt»*2/DONE*I5TOT»DONE ) 

3950  DP5I •<DPHI*AONC-EREST*(OPSI»DONE-DPHIINIAONE ) l/DONC 

3960  PHI0»PHI/Z2 

3970  PSID*P5I/ZZ 

3980  IF  (PHITOT.GT.30,.AWO.PHITOT.LT.(PMICUTD-30. ) )  CO  TO  3 

3990  WRITE  (6,4) 

4000  WRITE  (6,5)  PHID.DPMI.PSID.DPSI.PMITOT 

4010  3  RETURN 

4020  C 
4030  C 
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4040  C 

4050 

40fc0 

4070 

4OS0 

4090 

4100 

4110 

4126 

4130 

4  140 

4150 

4150 

4170 

4180 

4190 

4200 

4210 

4220 

4230 

4240 

4250 

4260 

4270 

4280 

4290 

4300 

4310 

4320  C 

4330 

4340 

4350 

4360 

4370 

4380 

4390 

4400 

4410 

4420 

4430 

4440 

4450 

4460 

4470 

4480 

4490 

4500 

4510 

4520 

4530 

4540 


4550 

4560 


4570 


4  FORtli^T  «  lH0,SX,6HinPACT) 

5  FORMAT  <  1H0, 1B'<,4HPHI«.F8.3.3X.7HPHIOOT-,F8.3,3X,4HPS1*,FB.3,3X.7H 
1P5ID0T>,FS.3,3X,8HPH1T0T  -.FQ.a) 

END 

subroutine  FCT  CT.PMI.OPHI) 

COMMON  A,B.c,R,ALPHR.Pi.z2,Mi.n2,(i3,n4,np.n, la.n. I4. IP.EREST.LAM 

lFDA.DELTA,PHIT0T.PHIPR.M41.N42,N43,0n£CA.OI12,RCl,PMllC,TESTl.TEST2 
2.TEST3.NGl.NC2,N(i3,NP2,NP3.NP4.CAPRBl,CAPRB2.CAPR83,RB2,RB3.RB4,TH 
3ETAl,THETA2,ThETA3.Rl.R2,R3,R4,R5.RH01.RH02,RH03,RH04,RHOP,Jl, J2,J 
43,PETA1.BETA2.BETA3,BETA4,D1,D2.D3,AL1IN.AL1FIN. J.TAMC.NT, 
6AL21N,AL2FIM,AL31N,AL3FIN,ALPHAl.ALPHA2,ALPHA3,lN,T2,T3.T4,nu,MUl. 
7RCP,P5IC,Sl,S2,S3,S4.SS.Al,A2.A3.DPHI2,DPSI2.F34nAX.Fa3HAX.F12l1AX, 
SFF34nAX,FF23nAX.FF12riAX.PNnAX.PHICUTD,AA,AN,S6,S7 
DIMENSION  PHl(2),  DPHI(2) 

REAL  ni.M2.n3,n4,nP,ll,12.I3.l4, IP.IlR.N41.N42.N43,nu,MUl,IPR 
PMID'PHI i 1  )/2Z 
PELPHl-PHID-PHIPR 
PHIT*(PHlTOT*OeLPHI  )*ZZ 

IN-  I 

CALL  LINLM  (A,B,ALPHR,PHI.R,C,G,P.Q,S,GDOT.PSI,DPSI,AONE.BONE.CONE 
1,D0NE,U,U,Z  ) 

CALL  GCURUE(T,AA,AN) 

Call  IN3  (PH[,PHlT.DELPHI.CDOT,PSI.DPSI.ftONE,BONE,CONE,DONE,AAl,AA 
12.AA3.AA4, AAS,AA6.AA7,AA8,AA9.AA10.AAll,AAt2,AA13,AA14,AAl5.AA16,A 
2A 1 7 , AA 1 8 ,  AA 1 9 , AA20. AA2 1 . AA22 , AA23. AA24 , AA25. AA26. AA27>  AA28 , AA29 , AA 
330, AA31 , AA32, AA33,AA34,AA35.AA36,AA37.AA38,AA39, AA40,AA4I,AA42^AA4 
43,AA44.AA45,AA46,AA47.AA48,AA49,AA5e.AASl.AA52.AAS3 ) 

CALL  [N3A( AA54,AA55.AAS6.AAS7.CAPftB2,HU,RH02.AA51,AA53. 
TS1,S2,AI,A2,56,57, AA49, AA50 . AA4g , AA52 , 01 , RB2  > 

IF  (DPSI»DPSI2.Ce.0.  )  IPR-IP*AA15 
IF  (DPSIBDPSI2.LT.0. )  IPR-IP-AAIS 

IF  (PHI(2  )*DPh;2.CE.6.  )  nR-llTABS(nU)»RHOl*(AA30+AA33) 

IF  (PHl(2)tOPHI2.LT.0. )  tlR-lI-ABS<nu)<RH0tt(AA304AA33) 

IF  ( IlR.LT.0. )  IlR-0.  , 

IF  ( 1PR.LT.0. )  IPR-0. 

AA5B-AA25tlPRtUTAAll«l4-AAll<AA2£/'(AA34tAA44tAA5<l)>(AA47lAA57»N41 

ltIlR*AA34XAA54tl3<N43-AA34XAA47<I2<N42) 

AA59-AAl4SAA25tUI«2*AA2St 1PR*0>RA| 1IAA22<AA37<AA47<A057XN41X t2 
4/(A034XAA44XAA54) 

AA60-AAI 1 XAA22/ ( AA34XAA44tAA54 )<(AA35XAA47<AA57-AA34XAA47XAA55- 
10A34XAA45tAAS4)TAAllXAA23»AAt2tAA25-AA25<MPXRCPBSlN(PSlTPSIC )t 
2SIN(BETA4 )tAA25<HP<RCPXCOS<PSItPSIC)<COS(BETA4 ) 
AA61-AAlt<AA£2/(AA34X0A44XAAS4)t(AA36XAA471AAS7-OA34>AA47XAA56- 
lAA34IAA46XAA54)*AAllXA024»AA13<AA25-AA25<MPX9CPtSlN(PSI*PSIC  )X 
2C0S<BETA4  )-AA25<MPXRCPXCOS<PSI*PSlC)XSlli(BETA4) 

DPMI  (1  )»PHI(2) 

DPMI  12 )• ( -AAS9XPHl(2)«2tAA69XAA*AA61XAN  >/AA58 

RETURN 

ENO 

subroutine  OUTP  (T-PHl,DPHI,IHLF,N01M,PRnT) 

REAL  m,M2.M3,n4,MPJJ,I2,I3,I4,IP,nR,M41,N42,M43,MO,nUI,IPR 
DIMENSION  PH1(2).  0^1(2).  PRMTIS' 


4580  CCnnON  A,B,C,R,nl.PK*>,PI.22.Ml  ,n2,n3,  n4 , np,  1 1 ,  :a ,  I3,l4.  IP.EREST.IPM 

^S90  1  BDfl,  delta, PHlTOT, PHIPR, N41, N42,N4  3,onECfi,cna,RC I  .PHUC.  TEST  1,TEST2 

■4600  2.TEST3.NGl,NG2.NC3,NPa,NP3,NP4,CAPPBl  ,CAPRB£,CAPRB3,RBa.RB3,RP'4,TH 

4610  3ETA1 ,TMETA2,TMeTA3,Rt ,»2,R3.R4,R5, RHOl,RHOe,RHO3,RH04,RHOP, Jl.  J£, J 

4620  '«3,BETAl,BETfl2,BETA3,8eTA4.Dl.D2,D3,  ALIIN,  ALIFIN,  J.TANC.NT, 

■4630  6ALa  IN,  AL2F  IN,  AL3lM,AL3riN,ALPHAl,ALf‘'‘^£,  alphas,  IN,T2,T3,T4,nU,NUl, 

4640  7RCP, P6 IC, S  1,62.53, 54, S5,A1,A2, A3,  DPHI£,DPSI2,F34HAX,f23flAX,Fi2nAX, 

4650  8FF34flAX.FF23nAX,FFl£nAX,PN(1AX,PHrCUTD,AA,  AN,S6,S7 

4660  COnnON  .'2ETA/  PSl  ,TIHE  ,C,  DPSI  ,CP 

4670  PHID«PH1  (  n/2Z 

4680  DELPHI -PHID-PHIPR 

4690  PHTPR*PHID 

4700  PHIT0T*PHIT0T4DELPHI 

4710  PHIT.PH1T0T422 

4720  IN*C 

4730  CALL  XINEn  < A, B , ALPHR .PHI.R.C ,C, P, 0, S.CDOT.PSl , DPSI , AONE, BONE .CONE 

4740  1  .rONE.Ll.U.Z  ) 

4750  CALL  OCURi.'E(T,AA,AN) 

4760  CALL  1N3  iPHi , PhIT, DELPHI. CDOT, PSl . DPSI .AON£ , BONE . CONE, DONE, AAl . AA 

4770  12,Aa3,AA4,AAS,AA6,AA7,AA8,AA9.AA10.AA11.AA12,AA13, AA14, AA15,AA16,A 

4780  aA17, AA18,AA19,AA23,AA21.AA22,AA23, AA24,AA25,AA26. AA27,AA28,AA29, AA 

4790  330,AA3l  ,  AA32,AA33,AA34,AA35,AA36.AA37,AA38,AA39,AA40,AA4t,AA42,AA4 

4800  43,Aa44.AA45,AA46,AA47,AA48,AA49, AA5e,AASl,AA52,AA53) 

4810  C 

4820  CALL  1N3A(  AA54.  AA55.AA56,AA57,CAPRB2,n'J.RH02,AA51 ,  AAS3. 

4830  ♦ S 1 , S2 , A 1 , A2 , S6 , S7 , AA49 , AA50, AA48,  AA52, D 1 , RB2 ) 

4850  IF  (DP5I»DPSI2.GE.0. >  IPR«1P*AA1S 

4860  IF  (DPS1FDPSI2.LT.0. )  1PR«1P-AA15 

4870  IF  (PHI(2)1OPhI2.C£.0.  )  HR*  IHABS  ( M’J  )*RH01 1  ( AA30+AA33  ) 

4880  IF  (PHI<2)»L'PH12.LT.0.  )  1 1R«  1 1-ABS(  NU  )|RH01*(  AA30*AA33  » 

4890  IF  (llR.LT.e. )  IlR-0. 

4900  IF  (lPfi.LT.0.  )  IPR-0, 

4910  AAS8-AA25»lPR»LI+AAll*I4--AF.U»AA22/(AA34»AA44tAA54  )t(AA47lAA57»N41 

4920  I *llfi+AA34tAA54»I3*N43-AA34fAA47»I2»N4?) 

4930  0A59-AA14*AA2S*U*»2'tA025*IPRtyAAlUAA22»AA37»AA47IAA57»N41t»2 

4940  -f/C  AA34»AA44<AA54  ) 

4950  AA60*AP1 1IAA2c/<AA34»AA44»AA54)I(AA3S*AA47*AA57-AA34IAA47»AA5S 

4960  IAA34*Ah45»AA54  )'kAAU»AA23»AA12JAA25-AA25»nPtRCPJSlNlPSI'*PSIC)* 

4970  2SINt8ETA4  )»AA25»nPIRCPtC0S(PSI«PSIC  )*C0S(BETA4 ) 

4980  AA6 I -AA 1 1 1 AA22/ ( AA34XAA44>AA54 )I( AA36»AA47»AAS7-AA34»AA47I AA56' 

4990  1AA341AA46IAA54  )*AAU»AA24«AA13*AA25-AAR5*nPIRCPtSlN(PSUPSIC)» 

5000  2C0S1BETA4  )-AA2S»nP»RCP»C0S(PSI<PSIC  )*SIN(BETA4 ) 

5010  DPMI2* ( -AA591PHI ( 2 )l»2« AA60»AA*AA61 »AN )/AA58 

5020  DPSI2*U»DPH124‘3IPHI(2  )«PHU2) 

S03d  c 

5040  C  COHPUTATIOH  OF  CONTACT  FORCES 

sose  c 

5060  F34>l/(AA34|AA44tAAS4)t((AA35lAA47SAA57-AA34tAA47tAA55-AA34SAA45> 

5070  1AA54 )»AA*(AA36»AA47tAA57-AA34»AA47»AA56-AA341AA46»AA54 )»AN*AA37» 

5080  2AA47»AA574N4l»«2»PHI<2)»PNl(2)»(AA47»AA57»N41«IlR*AA34*AA54H3«N43 

5090  3-AA34tAA47II2<N42)tDPHl2) 

5100  F23*<AA44tF34'»AA45IAA4AA46tAN-13tN43tOPHI2)/AA47 

S110  Fl2«(AAS4IF234AA5S<AA*AAS6tAN«l2tN42tOPMI2)/AA57 

S120  IF  (F34.0T.F34NAX)  F34fMX*F34 
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5139  IF  (F23.GT,F23noX)  F23I1AX.F23 

5149  IF  (Fia.GT.FiarflX)  Fl2(1rtX»Fl2 

5159  PN«(-I4tDPHI2tA022tF34*AA23lAA4AA24tAN)>'A«25 

5160  PNPSI*( IPR»DP512+AA14«0PSI»DPSI-Aftl21AA-AA13*fiN*NP»RCP«CflA*(51N< 

5179  1PSI4PS1C )»5IN(BETA4)-C05(P5I*PSIC)»C0S(BETA4) )+AN*(SIN(PSI*PSIC)I 

5189  2C0S(B£TA4)+rC5<PSI+PSlC )*SlN(BeTA4 J ) j l/AAl 1 

5199  IF  (PN.GT.PNnAXl  PNHAX*PN 

5299  C 

5219  C  TEST  FOR  CONTINUATION  OF  COUPLED  NOTION 

5229  C 

5239  IF  ( .NOT. (C.LT.0. .AND.PN.CT.9.  ) )  PftNTIS >*2. 

524C  C 

5259  C  UR  HE  OUTPUT 

5269  C 

5279  PSID*PSI'2Z 

5289  IFi J.EO. J/l999tl099)  GO  TO  59 

5299  IF  (PHlT0T.GT.3e. .AND, PHITOT.lt. rPNlCUTD-39. ) >  CO  TO  1 

5399  50  URITE  <S,2)  T ,PHI D.PHI <2 ).C,C00T,P5ID. DPSI ,PHIT0T^ F34. F23. Fl2, PN,P 

5319  1NP5I,DPhI2 

S.'»20  1  TIME.T 

5330  J»J»l 

5340  IFiPHITOT.GE.PHiCUTO)  PRnT(5)*l. 

5350  RETURN 

5360  C 
5370  C 

5389  2  FOPMAT  (6X,3HT  • , F8.5. 3X.SKPHI  • ,F7.2, 3X, 8HPHID0T  • .F7.2, 3X. 3HC  •, 

5399  1F6.4,3X,6HCD0T  • , Fg. 2, 3x,6hPS ID  * .F7. 2, 3X. 8HPS 1  DOT  • .F8.2. 3X, 8HPHI 

5400  2T0T  •,F9.2^20X,SHF34  • . F9 . 4, 3X.5HF23  • .F9 . 4, 3X.SHF 12  • .F9. 4, 3X, 4HP 

5410  3N  ' ,Fi0.4, 3X,7HPNPSI  • , F J9 . 4, 3X, 7HDPH 12  •,£12,4) 

5420  END 

5430  SUBROUTINE  FCTF  (T.X.DX) 

5440  CONMON  A,Ii,C,R.ALPHR,PI,Z2.(1i,n2,«3,f14.NP.n.I2,I3,l4,:P,EREST,LAN 

5450  IBDA, DELTA. PMITOT. PHIPR,N41,N42, N43,0nEGA.0N2, RCI, PHI 1C. TE5T1,TEST2 

54g0  2.T£&T3,NG1,NG2.NC3.NP2.NP3.NP4,CAPRB1,CAPRB2,CAPRB3,RB2,RB3,RB4.TH 

5470  3ETA1 ,TH5TA2,THETA3,R|,R2,R3,R4,R5,fiH01.RM02.RH03,RHO4,RH0P.Jl,J2,J 

5480  43,BETai.BETa2.BETA3,BETA4.D1,D2,D3,ALIIN,ALIFIN,J,TANG,NT, 

5490  6aL2IN,hL2F1N,AL3IH,AL3FIN.ALPHAI,ALPHA2.ALPHA3.1N.T2,T3,T4,NU,NU1, 

5500  7RCP.PSIC,SI ,S2,S3.S4.S5,Pl.A2.A3,DPHI2,DPSI2,F34NAX,F23NAX,F12nAX, 

5510  8FF34nflX,FF23NMX,FFl2NAX,PHNAX,PHICUTD,AA,AN.S6,S7 

5520  DINENSION  X(4»,  DX(4) 

5530  COnnON  /ZETA/  PSI.TINE.C.DPSI.GP 

5540  REAL  ni.n2.n3.n4,NP.Il,I2.I3.I4,IPR.llR,nu,HUl,N41,N42.N43, 

S5S9  ♦IP 

5569  PH10-X(1)XZZ 

5579  DELPHI. PHID-PHIPR 

5580  PHlT-CPHITOT+DELPHmZZ 

5599  IN-1 

5699  CALL  GCURUE(T,AA,AN) 

5619  CALL  IN3  ( X.PHIT . DELPHI .0. . XO ) .X(4 >, 9. , 9. .9, ,9. . AAl , AA2, AA3. AAA. A 

5629  1A5,AA6,AA7, AAB,AA9,AA19.AA11,AA12,AA13. AA14.AA15,AA16.AA17,AA18,AA 

5639  2:9,AA29,AA21,AA22,AA23,AA24,AA2S.AA26,AA27,AA28.AA29.AA39,M31,AA3 

5649  32,AA33,AA34,AA35. AA36,AA37,AA38.AA39,AA49.AA41,AA42,AA43.M44,NA4S 

5659  4 . AA46 , AA47, AA48 . AA48 , MS*. AASl , AA52. AA53  » 

5669  C 

5679  CALL  IH3A  ( AAS4,AA5S,AA66.AAS7,CAPfil2,nU,m402,M5l,MS3, 
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S680  «S1 , sa , A 1 . 03, SE, 57, AA49. AASe. AA4a, AAS3, D 1 , RB3 ) 

5690  C 

5700  IF  (X( 4  ItDPSia.QE.A.  )  IPB-IP+AA15 

5710  IF  (X(4 JtpPSia.LT.O.  )  IPR-IP-AAIS 

5730  IF  (X(3  itDPHia.SE.e.  )  I IR- 1 1*ABS(«U  itRHOl * ( AA30+AA33 i 

5730  IF  ()>;(3)tDPHia.l.T.0.  )  IlR-Il-ABS(flUllRHOl*(AA30»AA33) 

5740  IF  i IlR.LT.a.  )  IlR-0. 

5750  IF  CIPR.LT.O.)  IFR-0. 

5760  IF  (IPR.EO.0.)  JRITE  (6.1) 

5770  AAbO'AAl 1 tAA33/( AA34XAA44tAA54 )S(AA35tAA4?tAA57-AA34FAA47XAA55- 

57SO  ♦AA3'HAA45*AAS4  )+AAn»AAS3*AAl3tAA25-AA35»riP»RCP»SlN(PSI*P5IC)» 

5790  ♦6INi  PETA4  HAA35*nPtRCPtCOS<PSI*PSlC  )»COS(  BETA4  ) 

5800  AA61  •  AAUtAA22.M  AA34*AA44XAA54)t(AA36tpA47tAA57•AA34XAA47tAA56- 

5810  ♦  rtA3-t»AA46»AA54  !+AAl  l»AAa4*AAl3*AA25-AA36iriP»RCP»SIN(PSl«'PSlC  )* 

5820  ♦C05iBFTA4)-AAa5»nP»RCPXC0S(PSl4PSIC)»51N(PETA4 ) 

5330  AA6a«IPR 

5840  AAb3'AA12-nP»PCP»(SlN(PSl+PSIC)tSIH(BETA4 )-C0SlPSl4PSIC )»COS( 

5850  1BETA4)1 

5860  AA64.AA13-ftP»RCP«(SIN(PSI*PSlC)*C0StBETA4  )-COS( PSl *9510  )»S INI 

5870  lf£T«4ii 

5880  AA65- I4-AAaa4( AA34XAA44XAAS4  »»( AA47tAA57XN41»1 1R*AA34»AA54»1?»N43 

5890  1 -AA34»AA47ll2»N4a) 

5900  AA6b*-AAaaiAA37*AA47»AAS7*N41*»2/<AA34tAA44»AAS4 ) 

5910  AAb7'AAaa/( AA34(AA4  4XAA54  >(( AA35tAA47XAAS7-AA34tAA474AA55'AA34t 

5920  1 AA45XAAS4 UAA23 

5330  AA63<AA22^ i AA34(AA44tAA54 )t ( AA36tAA47XAA57-AA34«AA47SAA56-AA34t 

5940  lAA46tAA54 )4AA24 

5950  Dx(1)jX(2) 

5960  Dxi3)*xi4) 

5970  DX  ( 2  )  •  (  AA674AA'»AA68tAN-AA66tX(2  )»t2  )/AA65 

5980  DX(4 l>(AA63tAA*AA64tAN-AA14tX(4)<t2)/AA62 

5990  RETURN 

6000  C 
6010  C 

6020  X  FORtlAT  '40H01PR  EQUALS  ZERO  -  SlflULATION  TEF/BINATED) 

6030  END 

604C-  subroutine  OUTPF  (T,X.DX.lHLF,NDll1,PRt1T) 

6050  CCriNON  A,B.C,R,  ALPHR.PI,ZZ,«l.ll2.t13,n4.nP.n,  12, 13,I4,IP,£REST,LAn 

6060  1 BDA, delta, PHI  TOT, PHIPR, H41,N42,N43,0nEGA,0N3,RCl, PHI IC, TEST  I, TEST2 

6070  3,TEST3,NGl,NC2,NG3,NP2,MP3,MP4,CAPRBI,CAPRB2,CAPRB3,RB2,RB3,RB4,TH 

6080  3ETA1.ThETA2,THETA3,RI,R2,R3,R4.R5,RH01,RH02,RH03,RH04.RHOP, JJ,J2, J 

6090  43,B£TAI,8ETA2,BETA3,8ETA4,DI,D3,D3,AL:IN,AL1FIN, J,TANC,NT, 

6100  6AL2IN,AL2FIN,  AL3IN,AL3FIN,ALPHAt,ALPHA2,ALPHA3,  IN,T2,T3,T4,nU,mjl, 

6110  7RCP,PSIC,Sl,S2,  S3,S4.S5.Al,A2,A3,DPHI2,DPSI2,F34nAX,F23(1AX,Fl2nAX. 

6120  8PP34rlAX,FF23nAX,FF12nAX,PNI4AX,PHICUTD,AP,AN,S6,S7 

6130  REAL  PI ,n2,n3,n4,np, 11,12, 13,14, lP.nR.N41,N42,M43,nu,nui.lPR 

6140  DirtENSION  X<4).  DX<4),  PRHTlS) 

6150  COPNON  /ZETA/  PSI , TIME ,G, DPSI,CP 

6160  PHID»X(l)/ZZ 

6170  PSID-XC3)/ZZ 

6180  DELPHI •PHID-PHIPR 

6190  PHlTOT.PMITOT»DELPHI 

6200  PMIT.PMITOTIZZ 

6210  PHIPR«PHI0 

6220  IN*0 

6230  CALL  CCURUE(T,AA,AN) 


e24« 

6290 
6260 
6270 
6280 
6290  C 
6300 
6310 
6320  C 
6330 
6340 
6350 
6360 
6370 
63SO 
6390 
6400 
6410 
6420 
6430 

6440 
6450 
6460 
6470 
6480 
6490 
6500 
6510 
6520 
6530 
6540 
6550 
6560 
6570 
6580 
6590 
6600 
6610  C 
6620  C 
6630  C 
6640 
6650 
6660 
6670 
6680 
6690 
6700 
6710 
6720 
6730 
6740  C 
6750 
6760  C 


COLL  :n3  iX.PHIT.DELPHI.OwXO  J.X(4).0.,0.,0..0..OA1.AA2.AO3,AA4.A 
1A5,AA6, AA7. AA3.AA9.AA10.AAll,AA12,AA13,AA14,AA15,AA16,AA17,AA18,AA 
219. AA20,AA21. AA22.AA23, AA24.AA25,AA26,AA27. AA28,AA29, AA30, AA31 ,AA3 
32, AA33, AA34. AA35,AA36.AA37, AA3a.AA39,AA40.AA41,AA42.AA43,AA44. AA45 
4,AA46,AA47.AA48. AA49,AA5e.AA5l.AA52.AAS3 ) 

CALL  IN3A  (AAS4.AAS5,AAS6.AA57.CAPRB2,nu,ftH02,AA51,AA53, 

«Sl,S2,At ,A2,S6,S7,AA4g,AA50,AA4S.AAS2,Dl,RB2) 

IF  (X(4)IDPS12.GE.0. >  IP«-1P*AA15 
IF  <X(4)»DPSI2.LT.0. )  IPR-IP-AA15 

IF  (X(2)tDPHl2.Ge.0, )  IlR*ll«ABS<NU)tRHOlt(AA304AA33> 

IF  (X(21trPHl2.LT.0,  )  I1R-11-ABS<I1U)»RH01J(AA30+AA33) 

IF  1 IIR.LT.O.  )  llR-O. 

IF  ( IPH.LT.0.  )  IPR-0. 

AAGO*  AAl  1  tAA22<'  (  AA34tAA44tAA54  )S(AA35tAA47tAA57-AA34XAA47tAA55- 
■^AA34(AA45tAA54)*AAlltAA23*AAi2XAA25-AA25snP)tRCPtSIN(PSI«PSIC  >« 

♦  S1N(  BETA4  )  +  AA25ll1P»RCPXC0S(PSI+PSIC)XC05OETA4) 

AA61  -AhI  1«AA22>'(  AA34tAA44tAAS4  >X(AA36*AA47<AA57-AA34tAA47«AAS6- 
«^AA34tAA46tAAS4  1»AA1 1  tAA24»AA13>AA25-AA25<nPXRCP>SIN(P5I^PSlC  >X 
+C0SI 8eTA4 )-AA25inPxflCPxC0S(PSl*P5IC)XSlN(BETA4) 

AA62 ' I PR 

MA63*AAl2-nPtRCP»(SlN(PSl*PSIC  >XS1N(BETA4  )-COS(PSI*PSIC )»C0S(BETA4 

I  '  > 

AAG4-AAl3-nPIRCPX(SIH(PSl»PSIC  >XC05tBETA4  )-COS(P5I  +  PSIOXSIN(  BETA4 
1  1  ) 

AAGS* I4'AA22/ (AA34tAA44tAA54)X(AA47tAA57tN41XllR*AA34XAA54tl3XH43 
l-AAj4JAA47* I2«N42  ) 

AAS6*  -AA22tAAj7tAA47tAA57XN4ttX2/’(AA34XAA44XAA54) 
AA67<AA22/(AA34tAA44tAAS4  )S ( AA35tAA47XAAS7-AA34XAA47XAA55-AA34X 
lAA4StAA54 )4AA23 

AA68*AA22/( AA34XAA44IAAS4)X(AA36XAA47SAAS7>AA34XAA47tAA56*AA34X 
IAA46XAAS4 )*AA24 
PSI*X(3; 

DPSI-X(4  ) 

IIPHI2>(-AA66tX(2)XX(2)4AA67tAA4AA68XAN>/AA65 
0PS12< ( -AAt 4 tX( 4  )XX ( 4 )4AA63tAA«AA64XAN IXAAae 

COnPUTATlON  OF  CONTACT  FORCES 

FF34>I l4}DPH12-AA23tAA4AA24tAN)/AA22 

FF23*(AA44XFF34*AA45tAA'»AA46tAN-I3XH43XCPH12)/AA47 

Fri2-<AA54XFF234AA5StAA4AA56XAN4|2XN42xDPHI2)^AA57 

Ir  (FF34.GT.FF34nAX  )  FF34nAX*FF34 

IF  tFF23.GT.FF23nAX  )  FF23nAX«FF23 

IF  (FF12.GT.FF12nAX)  FF12nAX«FFl2 

IF( J.EQ. J/1009XI0O0)  GO  TO  SO 

IF  CPHITOT. CT. 30. .AND.PHIT0T.lt. (PHICUTB-30.  ))  CO  TO  I 
50  WRITE  (6,4)  T,PH1D.X(2).PSID.X<4),PH1T0T.FF12,FF23,FF34 
1  IF  (T.EO.TIflE)  GO  TO  3 

J»J41 

CHECK  FOR  CONTINUED  FREE  NOTION 
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6770  C 
6730 
6790 
6800 
6810 
68S0 
6830 
6840 
68S0 
6860 
6870  C 
bttuO  C 
6890  C 
6900 
6910 
6920 
6930 
6940 
69S0 
6960 
6970 
6980 
6990 
7000 
7010 
7020 
7030 
7040 
7050 
7060 
7070 
7080 
7090 
7100 
7110 
7120 
7130 
7140 
7150 
7160 
7170 
7180 
7190 
7200 
7210 
7220 
7230 
7240 
7250 
7260 
7270 
7280 


F- A*3lN( X< 1 )-0LPHR  )-l*SIN<ALPHR  >-C*SIN(X( 1 )-ALPHR-PSI >-R 
CP»C»COSty( I )-ALPH9-PSI  )-B*COS( ALPHR )-A»COS(XI 1  )-ALPH« ) 
IF  (F.GT.0.  )  00  TO  2 
PRnT(5)-a. 

GO  TO  3 

2  IF  (GP.CT.0.)  PRnT(S)-2. 

3  TinE*T 

IFjPHITOT.GE.PHICUTD)  PRflTlS)*!. 

RETv  RN 


4  FORMAT  (6X,3HT  - ,f 8.5, 3X,SHPH1  -.F7.2, 3X,8HPH1D0T  -.FT.a.SX.SHPSI 
1*.P7.2,3X.8HP5ID0T  •,F8.2.3X.8HPHI70T  • ,F9.£/20X,6MFFie  •,r7.3,3X, 
26HFF23  •,F7.3.3x,6HFF34  •,F7.3) 

END 

SUBROUTINE  KINEH  ( A.B , ALPHR,PH1 ,R,C, G,P.Q, S.CDOT.PSl ,DPSI, AONE, BON 
IE, CONE, DONE, U. 0.2  1 
DIMENSION  PHI (2) 


RE^L  K 
PI-3.14159 

H-2  .  t( B*COS( ALPHR  )*A»COS(PHI ( 1 )-ALPHR ) 1 

K;-AtA»B»B«R»R-C»C42.»BtR»SIN(ALPHR)42.»A»B»C0S(PHl( 1 ))-2.*A»RtSlN( 


IPHl ( 1  )-ALPHR  ) 

GONE- (-H*S0RT(H»H-4.tK ) 1/2. 

CTU0-(-H-S0RT(HtH-4.»r )  )/2. 

IF  (abs(Gone).lt.abs(Ctuo>)  go  to  1 

G-CTUO 
GO  TO  2 

1  C-CONE 

2  P.B»SIN(PHI(1))4G*SIN<PH1(1 )-ALPHR)4RtC05(PHl<l )-ALPHR) 
0-B*COS(PHl(l ) )4CIC0S(PMI(1 )-ALPHR)-R»SIN(PHI(l )-ALPHR) 

S -G  +  BTCOS ( ALPHR )»AICOS (PHI < 1 )-ALPHR  > 

CDOT-PHl(a)*A»P/S 

PS1-ASIM(P/C) 

IF  (PSI.LT.O. )  GO  TO  3 
GO  TO  4 

3  PSI-2.»PI-ABS<PSI > 

4  OPSI-(Q»PHI(2)4CDOT»SIN<PHl(l  )-AlPHR))/(C»COS(PSI )) 
AONE-B*COS(ALPHR)4C 

BONE-B»SIN( ALPHR) 

C0NE--<R+C*SIN(PhI<1 )-ALPHR-PSl ) ) 

DONE-CtCOS(PMl(l  )-ALPHR-PSn 
Z-  (0+A»P/S»SIN(PHl(l  )-ALPHR)).'(CtCOS<PSI  ) ) 

U-(0»SIN(PHI(  1  )-ALPHR  )*P»A/S  )/'<C»C0S(PSl  > ) 

U-(0*AXP»S1N(PHX( I )-ALPHR)/S)#»2*TAH(PSI  )/(C«a2t(C0S(PSI ) )«I2)4( 1. 
1/(C*C0S(PSI )) )»<2.»A»P«C0S(PH1( 1 >-ALPHR)/S-P42.»At»2»P*(SlN<PHI(l ) 
2-ALPHfi))t»2/5»*2*A*0tSIN(PHI(l )-ALPHR)/S-AtI2tP*I2«SIM(PHI(l )-ALPH 


3R l/SXIS) 
return 
END 
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7296 

7300 

7310 

7320 

7330 

73^0 

7350 

7360 

7370 

7380 

7390 

7400 

7410 

7430 

7440 

7450 

7460 

7470 

7480 

7490  C 

7500  C 

7510  C 

7520 

7530 

7540 

7550 

75G0 

7570 

7580 

7590 

7600 

7610  C 

7620  C 

7630  C 

7640 

7650 

7660 

7670 

7680 

7690 

7700 

7710 

7720 

7730 

7740 

7750 

7760 

7770 

7780 

7790 

7800 


SUBROUTINE  I N 3  ( 2ZZ . PH I T . DE LPH I . GDOT . PS I , DPS I , AONE , BONE , CONE , DONE . 
lAHl,AA2.AA3,AA4.AA5.AA6,AA7.AA8.AA9.AA10>AAli.AA12. AA13,AA14,AA15. 
2AA16,AA17,AA18,AA19.AA20,AA21.AA22,AA23,AA24,AA2S,AA26.AA27.AA28,A 
3A29,AA30.AA31 .AA32,AA33,AA34,AA35.AA36,AA37.AA38,AA39,AA40,AA4UAA 
442,AA43,AA44,AA45,AA4E.AA47,AA48,A.'.49.AA50.AA51,AAS2.AA53) 
DIMENSION  2ZZ<4) 

COMNCN  A.B,C.R,ALPHR,PI,22,(11.n2.N3.«4.nP.Il.  12,13,  I4,IP.EREST,LA« 
1BDA.DELTA,PH1T0T.PHIPR,N41 ,N42.N43, ONEGA. Ona.RCl, PHI 1C. TESTI.TEST2 
2.TEST3,NCl.NG2.NG3,NPe,NP3,NP4,CAPRBl.CAPRB2,CAPRB3,RB2,RB3.RB4,TH 
3£TAl,THETAa.THETA3,Rl.R2.R3.R4.R5.RHOI.RH02,RHO3,RHO4.RH0P.Jl.ja,J 
43,BETAl,BETAa.BETA3.BETA4,Dt,D2,03.ALliN,ALlFIN,J,TANC.NT, 
6AL2IN.AL2FIN.AL3IN, AL3FIN,ALPHAl,AtPHA2,ALPHA3,lN,T2,T3,T4,MU,nUl, 
7RCP.PSIC.Sl,S2.S3.S4.SS.Al.A2.A3,DPHI2.DPSU,F34nAX,F23HAX.F12nAX, 
gFF34nAX.FF23nAX.FFiariAX,PNriAX,PHICUTD.AA.AN.S6.S7 
REAL  Nl.M2,n3.r4,HP,(1U.«Ul.N41.H42,N43,  Il.llR 
PHI-2Z2(1  ) 

DPHI.22Z»2) 

IF  iDPHl.EQ.0.  >  GO  TO  1 
nu»ABS(riUl»DPHl/ABS<DPHI  ) 

1  IF  (IN.EO.0)  GO  TO  2 

UPDATE  UALUES  OF  ALPHAS 

DELAL3-DELPHI»ZZ 

DELAL2*DELAL3»RB3/CAPRB2 

OELALl  •CELAL2tRB2/CAPRBl 

ALPHA1>alPHA14DELAL1 

ALPHA2*ALPHA2+D£LAL2 

ALPHA3 • ALPHA34DELAL3 

IF  (ALPHAI.GT.ALIFIN)  ALPHAt»ALl IN 

IF  (ALPHA2.GT.AL2FIH)  ALPHAa-AtaiH 

IF  ( ALPHAS. GT.AL3F IN)  ALPHA3*AL3IN 

DETERPIINATION  Of  SICNUNS 

2  IF  (ALPHA!. LT.TESTI  )  Sl*l. 

IF  (ALPHAa.LT.TCSTai  S8*l. 

IF  ( ALPHAS.  LT.TEST3)  S3M. 

IF  ( ALPHA!.  GT.  TEST  I  )  Si  — 1. 

IF  (ALPHAE.GT.TESTa)  Sa*-l. 

IF  (ALPHA3.GT.TEST3  )  S3«”l. 

IF  (ALPHAl.EO.TESTl  )  S!«0. 

IF  (ALPHAa.E0.TEST2>  52-0. 

IF  (ALPHA3.E0.TEST3)  S3*0. 

IF  (GDOT.NE.0. )  CO  TO  3 

54- 1 . 

CO  TO  4 

3  S4.CD0T/aBS(GD0T) 

4  IF  (DPSI.NE.e. )  CO  TO  5 

55- !. 

CO  TO  6 

5  S5*DPSI/ABS(DPSI) 
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7810  6  IF  (AA.NE.e.)  GO  TO  7 

7820  s6»l. 

7830  CO  TO  8 

7840  7  1 

7850  8  IF<AN.NE.0.1  GO  TO  9 

7860  $?• 1 . 

7870  GO  TO  10 

7880  9  S7«-(AN/ABS(AN) ) 

7890  10  COMTltiUE 

7900  C 
7910  C 

7920  c  COnPUTATIOfI  Of  Al.Aa  AND  A3 

7930  C 
7940  C 

7950  Al*ALPHAltCAP»»Bl 

7960  A2«ALPHA2tCAPRB2 

7970  A3«At.PHA3»CAPRn3 

7980  DENon-i .tnutnu 

7990  D£N0!11-l.+nui»nui 

8000  Pl'3. 14159 

8010  C 

8020  C  COnPUTATION  OF  AAl  TO  AAS7 

8030  C 

8040  AAl -ABSdnuiK 54-55  )»SIN< PHi -mLPHR  )- ( 1 . ♦S4»S5»mjl»HUl  )»COStPHI-ALP 

8050  IHR  )  )/DENOni ) 

8060  AA2.ABS(nP*(C05(BETA4)-nuitS5«SlN<BE.A4>] >/D£NOPl 

8070  AA3.Al(S(nP»(5IN(BETA4)-«Jl*S5»COS(BETA4) )  >/DENOPl 

8080  AA^ • ABS ( <  nPiRCPI ( 5 1 H<  PS  1 ♦P5 1 C  )-HUl »S5»C0S  <  PS I ♦PS  I C ) ) ) /DENONl ) 

8090  AAS*AtiS((nP»ftCP»<COS(PSl+PSlC)*«UHSS»SIN(PSl+PSIC)>)/DEHOni  > 

8100  AAO.ABSunui»(  54-55  )»C0S(PHI-ALPHR)4(l.+S4»S5»l1Ul»mJl  )*StN(PhI-ALP 

8110  lHfi))/DENOni  I 

8120  AA7*ABS(nP»(nuuS5tCOS(BETA4>+SIN<BETA4>))/I»€MOI11 

8130  AA8 ‘ABS ( nP« ( nu I ISStSIH ( BETA4 )+COS<  BETA4 ) ) )/DENOPl 

8140  AA9.ABSC(nPtRCP»(C05(PSl+PSlC)tnui»S5»SIN(PSI+PSlC>))/DEHOI11 ) 

8150  AA10*  ABS( (np*RCP»<siN<Psi«PsiC)-nui»ss*cos(Psr+PSiC)) )/DENoni > 

8160  AAl  1  •DONE«CONE«Hlll<S4-RHOP<nui«55*(AAl^AA6 ) 

8170  AA12*S6IRH0PIMU1»S5»(AA2+AA?I 

8180  AA13<S7<RH0P«rul*SS<<AA3^AA8) 

8190  AAt4*RH0PXPUUS5S(AA4^AA9) 

8200  AAl5«RH0PtriUlX(AA5«AAl0> 

8210  AA16*ABS(  (-<nui*S4-nU)<SlN(PHI-Al.PHR^BETA4>4(1.4PUtnul>54>«C0S(PHI 

8220  l-AlPHRfBETA4))^DEN0n) 

82  30  AA17*ABS(  (PU»ll.-S3)»SIN<BETA3+THETA3)+(l,+mjtnU»S3)»C0S(BETA3+TME 

8240  1TA3)  )/DEN0n) 

8250  AAi8«AB$<n4/DEN0n) 

8260  AAig<0BS(nUtn4/DENOni 

8270  AA2O*ABS<((l.+nUtmJl*S4)XSIH<PHI-ALPHR+B€TA4H(S4»m)l-IW>»C0SlPHI- 

8280  1ALPHR4BETA4 ) l/DENON ) 

8290  AA21  'ABSl  ( - ( 1  .♦HUtlWtSS )tSIN<BCTA34THETA3 )+WJ*(  1  .-S3 )BC0S1BETA3^TH 

8300  1ETa3))/DEH0N) 

8310  AA22«RB4-nu<(S3«03-A3)*RH04t(AA17*AA21}  > 

8320  AA23*nu«RH04SS«l(AA184AAl9) 

8330  A024>nutRH04tS7t(Mlt84M19) 

8340  AA2S«A0NE^IOfC<nuilM4nUBRHO4S(MlC4AA2O> 

8350  M3«'ABS((nU<(l.*Sl  tiSlNdETAUTHETAl  >-(  l.-nUiflU0$l  )BC0S(BCTA14THC 


8360  ITAl ) )/DCNOH) 

8370  AA27-ABS<nt/CEN0n) 

8380  AA88*ABS(nunU/DEN0n) 

8390  AAE9«ABSa(1HRClt(nU*C0S<PHIlC*PMITtN41  )^S1N(PH11C*N41»PHIT» ) 

8400  lOtl) 

84  je  AA30-ABS((t1l*RCU<COS(PHllC4N41tPHlT)-flU»SlN(PMllC*H41fPHIT)))/0EN 

8480  lOM) 

8430  AA31*ABS(<<l.-nu»nu*Sl >fSlN< BETAl ♦THETAl )»HUt(l.^St )*COS(BETAl-fTHE 

8440  ITAl  ))-'DENOn) 

8450  AA3a>AB9((nitRClt(C0S(PHllC4N41«PHlT)-nu*SIN(PNIlC«N41«PHIT> ) )/DCN 

8460  10(1 ) 

8470  AA33*ABS(  <l1l»RCl*(SIN(PHIlC*N41tPHlT)4l1U«C0S(PMIlC+h41«PHlT) )  )^DEh 

8480  lOtl) 

8490  AA34>CAPRBl-nU«St*Al4^nu«RH01t<AA26'»AA31  > 

8500  AA35*S6tnuxRH01t(AA27«AA28)*(11tRClSC0S(PHttC*^N41<PH]T> 

8510  AA36-S7»(1U»RH01t<AAa7*AAa8)-(11lRCl*SIN(PHIlC<H41*PHlT) 

8580  AA37«-nutRH01t(AA294AA32> 

8530  A/'38-AB5(<<l.+nu»nuiS2)IC0S(BETA8-THETA8>*l1Ut(S2-l.  )tSrH<B£TA8-THE 

8540  1TA8' )/DEMOri) 

8550  AA39*APS((1UJn3/'DEN0n) 

8560  AA40>AB$(n3/oeNoni 

8570  AA4 1 -aBS ( < ( 1 . -nutnuiS3  )»COS( BETA34THETA3  >-nu*( 1 .♦SS )»S1N<  BETA3+THE 

8580  1TA3  I  )/D£HOn) 

8590  Art48.AB5(  <  ( 1  .♦nut(1U»S8  »tSIN(B£TA8-THETA8  )+(1U»(  1  .-S8  )»C0S(BETA8-THE 

8600  iTAa )  )^pe^ol1) 

8610  AA4  3*A85( ( ( 1 . -nU»nu»S3  )*S1N< BETA34THETA3 )4nu«( 1 . ♦S3 )»C0S<BETA3+THE 

8680  1TA3  I  )  vDEN0(1) 

8630  AA44<CAPRB3-nUXS3tA34nU>RH03»(AA41 40643 > 

8640  AA4S*-nutRHO3<S6(<AA394AA40) 

8650  AA46«-n(jtRHO3xS7t(OA394AA40) 

8660  AA47 • RB  3 -nui ( sat ( 08-08 )4RH03t  <  AA384AA48 ) ) 

8670  aA48*ABS( »nuu l.-Sl )tSIN(B£TAl4THeTAi)«(l.t(1UtnUtSl )tC0$(BETAl4TH£ 

8680  ITAl ) )/D£HOM) 

8690  AA49*ABS(n8/D£N0(1) 

8700  AA50‘ABSfnuin8''0£Non) 

8710  AAS I • ABS I ( nui < 1 . *58 ) IS IN< BETA8-THETA8 )♦( 1 . -nutdUtSS  )tC0S t  BETA8-THE 

8780  1TA8) j^DEHOn) 

8730  AA58'ABS(  tnut<  1  .-51  )ICOS( BETAl ♦THETAl  )-<  1 . ♦RUtflUtSl  )tSIN(BETAl4TME 

8740  ITAl ) )/DENOn; 

8750  AA53«ABS(  ( ( 1 .  -nU((1U8S8  IISIMl  BETA8-THETA8  )-nUt(  1 . 458  )tC0S(BETA8-THe 

8760  1TA8) J/DEHOn) 

8770  RETURN 

8780  END 

8790  SUBROUTINE  IN3A  ( AAS4, 0A55. AA56.AA57.CAPRB8,I«J.RH08,AA51 . AA53. 

8800  *S1,S8.A1,A8,S6,S7,AA49,AA50,AA48,AA58,I>1,RB8) 

8810  REAL  NU 

8880  C  THIS  SUBROUTINE  COdPUTES  AA54-AA57 

8830  AA54  •  CAPR88«nU>RH08S  ( AAS  1  ♦  AA53  )-l1UtS8tA8 

8840  AA55*-nutRH08tS6<(AA494AA$0) 

8850  AA56*-nutRN08tS7t(AA494AAS«) 

8860  AA57*RB8-nUlSl»(Dl-Al  )-nutRH08t<AA4t4AA58 ) 

8870  RETURN 

8880  END 

8890  SUBROUTINE  AlPAICAPtBJd.THETA.CAPRO.RO.ALIN.AiriN) 

8900  ALZN*((CAPR|4RB)trAM(1>CTA)>$«^(M**0-ftDtRD>)/CAmD 

8910  ALfIN«SORr(CAMOtCAfltO<APRBXCRra»)/CAPRt 

8920  RETURN 


SjtROUTlNC  GCURuEtT .  AA ,  AN  1 
fi5«  connoN'CCv^  Tin(iM).CtiM>.CU(t«*>.N 

S;6i»  AA*». 

I'S'o  Wi.e. 

S98e  CO  TO  s« 

S99*  5  J*J-l 

900#  50  IFiT.tO.TlN<  J  )>  JM 

9010  IF(J.CE.N)  CO  TO  3« 

9oa«  :f  iT.co.Tin(j))  co  to  to 

9030  :F  .T.CT.Tin(J*l))  J*J»1 

9040  K  (J.CC.N)  CO  TO  30 

9050  IF;T.fO.T|N( J*l  ))  CO  TO  40 

9060  IF(T.OT.T|n(J  ).ANB.T.l.T.TII4«J*l  ))  CO  TO  20 

SOTO  IFd.UT.TlfKJ))  00  TO  S 

9080  CO  TO  20 

9090  10  M>C(J> 

9100  AN>CLiJ) 

9110  CO  TO  1000 

9160  eO  A«.iCiJ)*iCU*l  t-C(J)  l*(T-T|N(J)l^(Tin(J«l)-TIA<J)>) 

9130  AN.tCLi  J)*(CL(  J»1  )-Cl  (  J  1  »I<T-TIBC  J  )  )/«Tiat  J41  )-TlH(  J  )  1 ) 

5140  GO  TO  1000 

9150  3«AA*G(Ni 

9160  AN'CLINI 

91T0  CO  TO  1000 

5180  40  AA'Cl J<1 i 

9190  AN.CL<J*n 

5200  J<J*1 

5210  lOOO  AAM2.I32.2FAA 

9220  ANM2.t32.2tAN 

9230  OeruRN 


Tjrw  JTT  l.>  V  -.-V'.  -.  i 


“  V  «-■•  •  "V*  r  h  V  ''  i  «'• 

*  .-  *  • 
*'•-••  • 


APPENDIX  C 

CONVERSION  OF  TWO  ROTOR  SYSTEM  TO  AN  EQUIVALENT  SINGLE  ROTOR 


') 
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The  computer  simulation  has  been  written  to  model  a  pin-pallet  runaway  es¬ 
capement  with  a  three-pass  Involute  gear  train  driven  by  a  single  rotor.  The 
PATRIOT  M143  safety  and  arming  (S&A)  device  Is  an  example  of  a  mechanism  which 
could  be  modeled  by  this  computer  program  with  the  exception  of  the  single-rotor 
requirement.  The  PATRIOT  S&A  Incorporates  a  detonator  rotor  and  a  balance  rotor. 
This  two-rotor  system  is  used  to  reduce  the  effect  of  lateral  acceleratioi^  on  the 
timing  function  of  the  device.  For  example,  suppose  a  lateral  acceleration  A^ 
results  from  a  missile  maneuver  in  the  positive  X  direction  (fig.  C-1).  From  the 
position  of  the  rotors  shown,  this  acceleration  would  result  In  a  counterclock¬ 
wise  moment  on  the  balance  rotor,  as  well  as  a  counterclockwise  moment  on  the 
detonator  rotor.  Since  the  rotors  are  of  equal  size  and  number  of  teeth,  and 
have  similar  mass  properties,  the  resulting  reactions  are  virtually  equal  and 
opposite,  greatly  reducing  the  effect  of  the  acceleration  In  comparison  with  the 
effect  the  same  acceleration  would  have  on  a  single-rotor  system. 

To  use  the  computer  program  to  model  the  PATRIOT  S&A,  the  two-rotor  system 
must  he  modeled  as  a  single  equivalent  rotor. 

Detonator  Rotor 

Using  figure  C-1  ,  the  moment  balance  written  about  the  pivot  of  the  deto¬ 
nator  rotor  can  be  expressed  as 

'  N  Vd  ^ 

where 

F  =  contact  force  between  balance  and  detonator  rotors 
R  =  base  circle  radius  of  balance  and  detonator  rotor  gears 
fp  =  detonator  rotor  pivot  friction  torque 
=  mass  of  detonator  rotor 

r^  =  distance  from  pivot  center  to  c.g.  of  detonator  rotor 

A.  =  axial  acceleration  of  missile 
A 

Av  =  lateral  or  normal  acceleration  of  missile 

IN 

a  =  angular  position  of  detonator  rotor 

6p  =  angle  used  to  locate  c.g.  of  detonator  rotor 

Ip  =  mass  moment  of  inertia  of  detonator  rotor 
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Balance  Rotor 


Similarly,  the  moment  balance  can  he  perfoimed  on  the  balance  rotor.  At 
present,  the  resistive  moment  contributed  by  the  delay  escapement  assembly  is  not 
included.  The  resulting  equation  is  as  follows: 


-  A^  m^rg  sin  t  Oj)  + 


(C-2) 


where 


"B 


B, 


mass  of  balance  rotor 

angle  locating  c.g.  of  balance  rotor 


B 

Tg  =  distance  from  pivot  center  to  c.g.  of  balance  rotor 
=  angular  position  of  balance  rotor 
fg  =  balance  rotor  )>lvoC  friction  torque 

F.quacions  C-1  and  C-2  can  now  be  combined  to  form  a  single  equation  eliminating 
th.e  dependence  on  the  contact  force  F. 

-  f  +  f  =  -  A  m  r  cos  (b,^  +  4b®  +  a) 

B  D  ADD  D 


"B  ' 

h  +  45®  +  n] 

D  ^ 

»B-  -  V,  <C-3) 

Recognizing  that  since  the  two  rotors  are  of  equal  size  and  number  of  teeth. 


A. 

COS 

A 

B  B 

+  A 

m  r 

sin 

N' 

D  D 

- 

m„r„ 

sin 

11 

B  B 

a  =  -  $, 


a  =  -  4, 


o  =  -  C, 


(C-4) 

(C-'t) 

(C-6) 


From  figure  C-i  it  can  be  seen  that 


l3  -45'' 
B 


H  1 


lC-7) 


Using  the  gent  ratio  N\  ^  (equation  A-79),  the  balance  rotor  angle  and  its  deriva¬ 
tives  can  be  expressed  In  terras  of  the  escape  wheel  angle  <p  and  Its  derivatives 
as : 


■■  "4  1  ^ 


(C-8) 

(C-9) 

(C-10) 


Again  using  appendix  A,  equation  A-80 ,  the  balance  rotor  angle  can  be  expressed 
ns 


+  li  =  i/. 


N  6 


Ic  1  Uc  4l'T 
Final 'iv,  rewriting,  equation  C-5  with  this  Information 


(C-11) 


:  +  f  =  A 

II  n  A 


■m^r^  cos  (4.,^  t 

K'-B  ■  Vd  ^ 


(C-12) 


At  thi>;  p'iint,  c<inarlon  C-12  <;an  be  compared  to  the  moment  equation  for  the  rotor 
(eqnatiCii  A-I'1i  in  appendix  A).  It  can  be  seen  chat  the  effective  moment  of 
inertia  I.  ca.i  be  expressed  n.s 


1  ,  =  1|,  r  (c-n) 

Fniilp'i,  li  '  in  I,"'  si'en  that  additional  "driving  torque"  terms  (in  the  coetfl- 
s  'P  A.  and  A,,  on  rh*’  right  hae  side  of  the  equation)  have  arisen.  Tracing 
1  hr  111  ■in.i'i  Irlv'ii.r,  r.iroi.'  I’x  p  j  i.-s  s  1  on  bach  in  appendix  A,  it  is  found  that  eqiia- 
i'iO'.  A-!'.’,'  '  K  T.,,.;!,  b.  modified  to  account  for  the  additional  contribution 

o!  t  O'  ■  i'.'- 1  '  mn  !  .  1  : 


O  I 


IV-  1 
1'  II 


■V,,  '  --os  U,,,  + 

',S  •'  - 


4  I  'i  ' 


I  -I  -  III  r  sin  '•  t  N  i 

I  rl  In  4 1'^T' 


I 


(C-14) 


(C-15) 


To  avoid  signlflcanr.  mathematical  complexity,  this  modification  does  not  account 
for  the  pivot  friction  of  the  detonator  rotor.  In  appendix  D,  a  revised  version 
of  the  computer  simulation  is  presented  for  the  M143  S&A.  All  revisions  of  the 
program  to  make  It  suitable  for  simulation  of  the  M143  S4A  are  clearly  identi- 
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PROGRAM  M1A3SA 


'aI  CJ  Uf  U)  fu  f'i  O-ZO)  r*J  f  J  fw  tufw  Hi 


PROC.^fifl  r  MT'JAC  INPUT, OUTPUT.  TAPES* INPU'^.TrtPEC "OUTPUT  ) 


I'O 
1  S  0  0 
i?v'  ; 
'l\'  : 

'.0 

iO  C 

c 

•so 

?o 

60 

TO 

30 

90 

00 

10 

cO 

;-o 
3-sO 
350 
360 
37  0 
3S0 
390  0 
400  C 

403 

404 
410  C 

430 

4  30 

431 
433 

440 

450 

453 

454 
460 
470 
480 
4S0 
492 
494 
500 
510 

see 

5  30 
532 

5  34 
540 
550 
560 
570 
5  20 
59? 


Nt^TE  the  inclusion  CP  f1143  S6A  PARAMETERS  IN  COMMON 
ANO  REAL  statements  UHERE  APPLICABLE  IN  PROGRAM 


COMMON  A.P.O.R.ALPHR.PI ,22,Ml.M2.M3,n4.nP.l 1 . 12, 13. 1 4 , IP, EREST, LAM 
IPOA, delta. PHITCT.PHlPR,N41,H4a,H43.0MEGA,0M2,RCl .PHI  1C , .ESTl ,TEST2 
2, T£ AT  3, ho; .NCe ,NG3 ,NP2 . NP3,NP4, CAPRB 1 . CAPRB2,CAPRB3, RB2. RB3. RB4 , TH 
TETAl .ThETA£,ThETA3,R1,R2,R3.R4.R5,RHO1,RH02,RH03,RH04,RH0P. J1 , J2, J 
4  3. beta  1 . BET A2, BETA3 , BETA4, 01 . D2, 03, ALl IN, ALIP IN, J, TANG, NT , 
bALcIN, AL2C-  IN, AL3 IN, AL SPIN, ALPHA  1 ,ALPHA2, ALPHAS, 1N,T2,T3,T4,MU,MU1, 
TRCP.PSIC.Sl ,?2,S3,S4,55,Ai ,A2,A3,DPH12,0PS12,F34nAX,P23nAX,F12MAX, 
SPPSAMAX.PPeSMAX.PP l2MAX,PNnAX,PHICUT0,AA,AN,S6,57,BD,RD, ID.MD 
C 'MM'jn  -ZETA^  PSI  ,TlnE,C,DPSl.GP 
COMMON  OCU  Tintia0).GA(100).Cl.(100).N 

DIMENSION  AUXiS.ai,  AUX2(8,4).  PRIIT(S).  PH1(2),  DFHll2),  X(4),  DX( 

’peal  n:,na,ri3,n4.np,it.  12,13,14,  ip, lambda, ic.N4i.N4a.N43.Ji.j2,J3,N 
IGl  .NG2,NCi3,NP2,NP3,NP4,nu,nui.  ID.MD 
EVTERNhL  PCT,0UTP,PCTP,0UTPE 


READ  IN  AND  URITE  data 
URITE(6.300) 

300  f ORMaTi 'EiCAPEMENT  DATA*///) 

REAL'S  5,22  jA.B.C.R.ALPHA 
URlTE(6,23i  a,B,C.R,aLPHA 
RE ADl 5 , 32  )  BETAI , BETA2, BETA3 .BETA4 
URITE(b,4l  )  BETAI, BETA2,BETA3.BETA4 
READ  (5,241  EREST, LAMBDA, DELTA 
URITE  (6,25  )  EREST, LAMBDA, delta 
URITE(6,301  » 

301  FORMAT  I  'MASS  PROPERTIES*/// ) 

READ  (5,26)  Ml ,n2,n3,M4,MP 
URITE  (6,27)  Ml ,M2.M3,n4,MP 
READ  (S,2G  (  ll, 12, 13,14, IP 
URITE  (6,2S)  11,12,13, 14, IP 
URITE(6,3aa  ) 

302  format  (///*MISCELLANE0US  parameters*///) 

READ  (5,291  RCl,HCP,RHOP.PHllC,PSICCD,PHlD.PHICUTD,MU,nUl 
URITE  (6,30)  RCI.RCP.RHOP.PHIIC.PSICCD.PHID.PHICUTD.MU.MUI 
READ  (5,3)  )  P5UBD1 ,PSUBD2.PSUBD3,NG1,NC2.MG3,NP2.NP3,NP4,C0PRP1.CA 
1PRP2 , C APRP3 . RP2 , RP3 , RP4 , THETAl . THETAE ,THET A3 
URITE(6,303  ) 

303  format  (///*C£aR  PARAMETERS*///) 

URITE  (6,35  )  PSUBD1,PSUBD2.PSUBD3.NC1.NC2,NG3,NP2,NP3,NP4,CAPRP1,C 
I APPP2 , C0PRP3 , RP2 , RP3 , RP4 , THETAl , THETA2, THETAS 
READ  (5,32)  RH01,RH02,RH03,RH04 
URITE  (6,37)  »h01,RH02,RH03,RH04 
READ  (5,33)  CAPflBl,CAPRB2,CAPRB3,RB2.RB3,RB  ( 
uPITE  (6,38)  CAPRB1,CAPRB2,CaPRB3,RB2.RB3,RB4 
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r'cO 
610 
b' 0 

630 
633 
63^ 
660 
6-'0 
6S0 
690 
700  C 
710  C 
^■OO  C 
7  30  C 
740  C 
7S0 
760 
■■70 
730 
790 
£00 
610 
$cC  C 
£30  0 
£40  C 

8S0  C 
860  C 

863 

864 
3"0 
830 
890 
900 
910 
930 
930 
i>4  0 
330  C 
960  C 
970  C 
980  C 
990  C 
1000 
1010 
1030 
1030 

1040 

1050 
1060 
1070 
I  050 
1090 
1  1  00 


READ  (5,33)  CAPR01,:app05,CAPR03,R02,R03,R04 
URITE  (6.39)  CAPR01.CAPROa.CAPP03,R02,R03,R04 
READ  (5,34)  J1,J3,J3 
URITE  (6,40)  Jl.J2,J3 
uRITE(b,304) 

3(.'4  FOrtr-AT (.-/,•  ANGIE  INDEXING  PARAMETERS*/'/) 
REAri5,S5)  TANG. NT 
UR;T£i6.90:  tang, NT 
S9  FOKIIAT  IF10.;-|,  13) 

90  FORMAT  i3v,*TANG  -  * , F 10. 3. 3X, 'NT  •  *.13/) 


FlAD  i  URITE  SPECIAL  DATA  FOR  t1M3  S6A 


R6aD(5.300)  BD,RD, ID.MD 
URITE  (6.301) 


URITE  (6,303  I  BD.RD.IO.MD 
30(>  FOR3ATi2Fi0.6/3E13.6  ) 

C01  FC'KflAT(  •//•SPECIAL  data  FOR  (1143  DETONATOR  ROTR*///) 

303  FORMAT ( 3X, ‘BD  •  * , F 1 0 . 6 , 3X , * RD  •  * .F10.6.3X. *  ID  •  ‘.Eia.G.SX 

♦TD  .  •,t;3.6^/////) 


READ  4  URITE  ACCELERATION  DATA 


URtTC'6,305i 

305  F0RMAT(///'ACCELERAT10N  PROFILE  DATA*///) 

ReHDiS,91  )  N 
91  FORMATilji 

READ  (5.93/(  Tini  J  ),CA(  J  ),GL<  J  ),J*l,N) 

S3  FORMAT  ( 3F10. 3  ) 

URITE  16,93:  (  TIM(  J  ),GA(  J  ),GL(  J  ),J«1,N) 

93  FORMAT  (F10.a,4X.F10,a,4X,F10.3/) 

URITE  (6,94) 

94  F ORMaT  (  //////■  > 


initialization  of  FARAMETERS  and  CONVERSION  TO  RADIANS 


J-0 

T  '  M."  •  0 
PH  I  TOT- 0. 
PH  IPS -PHI D 
DPHI 3*0 . 
D=S13*0. 

F  34MA/.  ■  0 . 
FRsnAx-e, 

F 1 cMA^  *  0 . 
FF  j4MAX  *0 . 
FF33MAX-0. 


90 


1110 

FFl2nAX*0. 

1120 

PNnAX«0. 

r.3x^ 

PI*3. 14159 

1140 

Z2*PP180. 

use 

PHllC*PHIlCtZZ 

1160 

PSICC*P5ICCD»22 

IITO 

P$IC*PS1CC 

1130 

ALPHR*ALPHA»ZZ 

1150 

C 

1200 

C 

1210 

c 

NOTE  11143  parameter  BD  TO  RADIANS 

1220 

c 

1230 

c 

1240 

ED*EDtZ2 

1250 

c 

1260 

c 

1570  C  C0Nl.)ERSI0N  TO  EfFECTlOE  MOnENT  OF  INERTIA  FOR  «H3  ROTOR  SVSTEn 
1280  C 
1290  C 

1300  ll'llMD 

1310  C 

1320  C  COriPUTrtTION  OF  GEAR  RATIOS 

1330  C 

1340  N41--NP2»NP3»NP4/(NGltNG2«NG3) 

1350  H42-NP3<NP4/(NG2ING3) 

1360  N43. -nP4<'NG3 

1370  C 

13B0  C  CONUERSION  OF  PRESSURE  ANGLES  TO  RADIANS 

1390  C 

1400  THETAI-THETAU22 

1410  ThETA2.THETA2»22 

1420  TH£TA3*THETA3*ZZ 

1430  C 

1440  C  DETERniNATlON  OF  GEAR  TRAIN  CONSTANTS 

1450  C 

H60  TESTI*TAN(THETA1 1 

1470  TE5T2*TAN(THETA2) 

1480  TEST3*TAN(THETA3) 

1490  C1«(CAPR61«RB2  ItTAIUTHETAl  ) 

1500  Da«(CAPRB2«R63)XTAN(THETA2 1 

1510  D3*(CAPRD3+RB41»TAN(THETA3» 

1520  C 

1530  C  DETERMINATION  OF  EARLIEST  AND  LATEST  POSSIBLE  VALUES  OF  ALPHAS 
1540  C 

1550  CALL  ALFA  (CAPRBl , RB2.THETAI .CAPROl .R02. ALl IN, ALIFIN » 

I5S0  CALL  ALFA  (CAPRB2.RB3.THETA2,CAPR02,R03,AL2IN,A12FIN) 

1570  call  ALFA  (CAPRB3.RB4,THETA3,CAPR03.R04,AL3IN,AL3FIN) 

1SB0  C 

1590  C  INITIALIZATION  OF  ALPHAS 

1C00  C 

:£10  ALPHA1«AL1IN4(AL1F1N-AL1IN>IJ1 

1620  ALPHA2*AL2IN+(AL2FIN-AL21N)»J2 

1630  aIPha3-AL3IN4(AL3FIN-AL31N)»J3 

1640  C 
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16S0  C 
1660  0 
iB'e 
1680 
1690 
1708 
1710 
1720 
1730  C 
1740  C 
17?0  0 
1760 
1770 
1730 
1790 
1300 
IS  10 
ls£0 
18  30 
iC-iO 
1S60  : 
1860  C 
1S'’0  C 
1  £30 
1S90 
1900 
1910 
1920 
1930 
1940 
1 950 
1960 
1970 
1930 
1990 
2000 
2010  C 
20C0  C 

2030  C 

2040 

2050 

2060 

2070 

2030 

fiO90 

2100 

10 

2120 

2130 

2140 

2150 

sise 

2170 

2180 

2190 


D9Tf>  FCR  RUN6E  klUTTA 

PRflT(2)-lC. 

PRnT(4)*.ei 

r<Din»2 

NDir:2-4 

PHI  (  1  )*PHID*t2 
PHI  C  2  )*0. 


col'PLEC  hot  I  cm 


1  PRrTi  1  '•TIO'E 
PRnT(  3;-  .0001 
PPHI ( 1 : •  .5 

IF^!fh1TOT. GT. 30. .AND. PHIT0T.lt. (PHICUTO- 30. ! >  CO  TO  2 
UKITE  16,42  ) 

2  CALL  RIGS  ( PRrr. PHI, DPMI ,NDin, IHLF.FCT.OUTP.AUX) 
ir  vPRHTlS 1 .EG.  1 .  )  GO  TO  21 

IP  (PNITJT.GE.PHICLITD)  CO  TO  21 

test  for  entrance  or  EXIT  ACTION 

: r  ■ 9 . ; f .  0 . )  GO  TO  5 
PHTj^Pnli  1  j/Z2 
IF  I ph;d. LE . TANG  1  GO  TO  3 
GO  TO  4 

3  PHI  (  1  NRHI  (  1  l•^DeLTA^2^*NT 

PHIPp.pHi  (  1  )/22 
P5I*PSl*2.*PI-LAMB0fi*22 
P5K  ■PS]CC  +  L9i7BDA*2Z 
go  to  5 

4  PHI  I  1  i-PHl  (  1  i-DEL'^A»22*(NT41  .  ) 

PHIPR'FHI  (  1  ).  ZZ 

PSI •PSI-2.*p:4LAMBDP»22 
PSIG'PSICC 

FREE  NOTION 

5  PRHTl 1 l-TINE 
XI  1  l*PhI < I  ) 

XI  2  I'PHI <  2  ) 

X(  3  )*P5I 

XI  4  )-CP5: 

DX(  1  )-.25 
0  /  <  2  .  2  5 

Dxi  3  !•  .25 
Dx  <  4  )  • , 25 
PRUT' 3)* .0001 

IF  CPHITOT. CT. 30. .AND. FHIT0T.lt. (PHICUTD-30. >  )  CO  TO  S 
URITE  (6,43) 

6  FALL  R<G&  (PRnT.X,DX,NDin2,IHLF,PCTF,OUTPP.ftUX2) 

U  (PhITCiT.GE.PHICUTD)  go  TO  21 
PHI  c  n*x(  1 ; 

PHI(P)'X(2  ) 
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m 


220t) 

2210 

2220 

2230 

£240 

2250 

2260 

22‘?0 

2290 

22S0 

2300 

2310 

2320 

2330 

2340 

2350 

2360 


2370 

'3S0 


2390 

2400 

£410 

2420 

£430 

2440 

2450 
2460 
2470 
24S0 
2490 
2500 
2510 
2520 
2530 
2540 
2550 
2560 
2570 
2580 
2590 
2600 
2610 
2620 
£6  30 
Cb40 
£650 
2660 
2670 
2630 
2690 
2‘’00 
2710 
2720 


M*2, t( BtCC5( ALPHR )+0»COStPHl 1 1  )-AlPHR  > ) 

K*6»0*B*B+R»R-C»C*a.»B»RtSIN(0LPHR)*2.*fitB»COS(PHI(l ) )-2 . *0IR*SIM( 
IPhl ( 1  i-ALPhR  ) 
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gone  -  (  -h*50RT(H1H-4  .  tlC)  )^2  . 

CTUO-  <  -H-iOPT(M»H-4 . 1<  )  l-'a  . 

IF  (AB6(00N5  )  .LT.ABSIGTUO > )  CO  TO  7 

C-CTUO 

CO  ’O  8 

G'GObE 

pHir-PHi ( 1  )^2Z 
!F  (GF.LT.0.  )  GO  TO  II 
IF  IFHIC.LE.TANGI  GO  TO  9 
00  TO  10 

FHI(  1  i-PHK  1  )4DELTA*22*MT 
PHIPF-PHIt  1  I^ZZ 
PSI'P^I'*2.*PI-L0nBDA»22 
F':!C'P3ICC-»L0nBD0t22 
CO  TO  5 

PHI  I  I  i-FHI  (  1  )-OELTO»2Z*(HT«-l  .  ) 

PHIFR'FHI  l  1  )^ZZ 

P3: -p^i-a. »pi *Lpn8DAi22 

FsIC*PSICC 

00  TC  5 

IF  iFHlD.LE.T0NG)  GO  TO  13 


EXIT  action 

COnPuTATICN  OF  UELOCITIES  OP  PHD  US  FOR  EXIT  ACTION 


AONE*B»COS’.  ALPHR)*G 
DCNE‘C»CCSlPHlil )-ALPHR-PSI > 
vF'DONEiDPSI 
OS*0ON£»PHI <2 ) 

IF  (FHITOT.GT. 30. .AN0.PhIT0T.lt. (PHlCUTD- 30  ))  GO  TO  12 
WRITE  (6,44  )  UP, 05 


EXIT  action  test 


12 


IF  (PH1(2).GE.0. .AND.DPSI. 
IF  1PHH2  ).GE.0.  .AND.DPSI . 
IF  (PHI (2 ) .GE .0. .AND.DPSI  , 
IF  (PHI (2 ) .GE .0. . AND. D’Sl  , 
IF  (PHI (2 ) .IE .0. .AND.DPSI  . 
IF  (PHI (2  ).LE .0. .AND.DPSI 
IF  tPMI  i2  ) . LE .0. . AND .DPSI 
(PHIl£).LE.0. .AND.DPSI 


IF 


GE.0.  )  GO  TO  15 

LE.0..AND.ABS(UP).CT.ABS(US))  GO  TO  5 
LE.e. .AND.ABStUP).LT.ABSIUS))  GO  TO  15 
le.0..ano.abs(up).eo.abs(us))  go  to  I 

GE.0. .AND.AbS(UP).CT.ABS(US))  CO  TO  15 
.GE.O.  .AND.AB5(UP).E0.ABS(U5)  J  GO  TO  1 
GE.e. .AND.ABS(UP  ).LT.ABS(US))  CO  TO  5 
LE.0. »  CO  TO  5 


COHPUTATIOH  OF  UELOCITIES  UP  AND  US  FOR  ENTRANCE  ACTION 


13  ACNE*BTC05( ALPHRUG 

D0NE»C»C0S(PHI(1 )-ALPHR-PSI ) 

UP-DCNE*CFSI 

US-AONf *PHI (£ ) 


r.N- 


r.' 


i:^ 


I 


N 

S'  V 


r.-/ 


l.‘  S' 


K 

f.  .. 


•»*  % 


'>1 


1 

M 

9 '3 

1 

l'j 

£T30  :F  (Fh:T0T.GT.30. .AnD.PHITOT.UT.(PHICUTD-30. ))  CO  to  14 

GRITE  le,  44  )  W.’JS 

c'50  C 

c  entrance  action 

2770  C 

a7S0  14  IF  CPmI  O ) .GE.0. .AMD.DPSr .GE.0. .«ND.ABS(UP).GT.ABS<US) )  GO  TO  S 
E79C  IF  (Phi  (  2 ) .GE.0. . AND.DPSI .GE .0. .AND.fiBS(OP).£Q. AB5(US ) )  GO  TO  1 

cSOO  IF  iPHli2 ) .GE.e. .AND.CPSI .GE.0.  .AND.flBS(yP).LT.fiBS(US) )  GO  TO  19 

cSlO  IF  iP-(I  (2  '  .  LE.O.  .AMC.CPSI  .CE.0.  >  CO  TO  5 

cSaC  IF  iP-:' 1  .GE.O.  .AMD. DPSI  .LE.0.  )  CO  TO  IS 

£S30  IF  iFnna ) . LE.O. . AND.DPSl .LE.0. .AMD.ABS(yP>.LT.ABS(OS ) <  GO  TO  5 

£?40  IF  iPhKcl.LE.O. .AHD.DPSI.LE.O..AND.ABS(OP).CT.ABS<US))  GO  TO  15 

23S0  :f  iPHI(2  ) . LE.O. . AMD.DPSI .LE.0.  .AND.A8S(UP).EQ.ABS<US) )  GO  TO  1 

2360  C 

2370  C  IF.PhCT 

£330  C 

£S30  IS  CALL  impact  iPHKl)  PHI  ( 2  ) ,P5I , DPSI ) 

2300  H  --  2 . 1 1  g  t  COS  (  ALPHR  )♦  AtCOS  ( PHI  ( 1  )- ALPhR  ) ) 

2510  K-H*t2*Bt*2*R*»2-C*l2  +  2.*BtP»SIN(ALPHI})»2.»A*BtC0S(PHI(  1  )  )-e.*A»RI 

25£0  ISlNiPHK  1  )-mLPhR  ) 

2530  GOME  - 1  -H  ♦SORT  (Hit  2-4.  »IC  )  )/£. 

2S40  GTLiO"  1  -H-S&RT(HI*2'4.*IC  )  )/£. 

25S0  IF  vAB3(G0mE  i.LT.AB3(CTU0>)  GO  TO  16 

£9bC  G-GT'.'O 

2970  C.Q  TO  17 

2SoO  16  G^uOMg 

2550  J?  CONTINUE 

oeoo  r 

3010  C 

3020  C  TEST  FOR  EXIT  ACTION 

3030  C 

3040  PHIC -PHI  c  n/22 

3050  IF  cPhID.LE.TANC)  GO  TO  19 

3060  C 

3070  ■;  EXIT  ACTION 

3060  C 

3030  C  CCr.PljTATlON  OF  OEtOCITIES  OP  AHD  VS  FOR  BOTTOn  ACTION 

3100  A0NE-B»C0S( ALPhR )*G 

3110  DO(-iE'C«CO$(FHl(  1  )-ALPHK  -PSi  ) 

3120  UP-D0ME4DPSI 

3130  US*ACiNE»PMl(2) 

3140  IF  (PhITOT, GT, 30. .ANO. PHIT0T.lt. (PHICUTD- 30. ) )  CO  TO  18 

3150  URITE  (6,44)  UP, OS 

3160  18  IF(AB5(UP-U5).IT.  1  .0)  GO  TO  1 

3170  C 


3ise  c 

EXIT  action  tests 

3190  C 
3200 

IF  i  pH  I  (  £  j  ,  GE' .  0  , 

AHD.ri  31  .CE.0. 

)  GO  TO  1 

3210 

IF  !  Ph I ( 2  1  . GC . 0 , 

AMD.:PSI.LE.0. 

.AND.ABStyp ).GT.ABS(US) ) 

GO 

TO 

5 

3320 

(Phi  (  2 ) .  GE.S , 

AND.  OPS1.LE.0. 

.AMD.ABS(UP).LT.ABS(US)  ) 

CO 

TO 

1 

3240 

!=■  (PhI  (  2  )  .LE.e  , 

ANH.DPSI .CT.0. 

.AND.ABS(UP).LT.ABS(U5) ) 

CO 

TO 

5 

3250 

IP  (PHll.P  ).LE.0. 

P  J.CPSI .GT.0. 

.AND.ABS(UP).CT.A8S(US ) ) 

CO 

TO 

1 

3270 

IP  (PhI<2,.'.p.0. 

H'iD.DPSI.LE,«. 

)  GO  TO  S 

< 


[iSM^ 


3c9C  C 

:-3co  c 

3310 

33£0 

3330 

33-40 

3350 

33tO 

3  370 

3330  C 

3390  C 

3400  C 

3410 

34£0 

3440 

3450 

3-460 

3470 

3490 

3500 

3510 

3520 

3530 

35  40  C 


COnPUTftTlCN  OF  UEIOCITIES  OP  «ND  US  FOS  ENTRANCE  ACTION 

19  A0NE-B*C0S(AI,FHR)*C 
DONE-C*COi  !  PHI  I  1  )-aLPHR-PSI  4 
•.■P-DONExDFSI 

U?*AONEtFHI (2 ) 

IF  (Pm1TOT.GT.30. .AND.PHITOT.LT.(PhICUTD-30. ))  GO  TO  20 
URnE  (6,-)4)  UP,U5 

20  I- ChP3(.UP-(.'5  )  .  LT.  1  .^4 )  CC  TO  1 

entrance  action  tests 

IF  (PHI (2!  .CE.0. . ANO.OPS: .GE.0. .AND.ABSIUP  )  .CT. ABSCUS ) )  GO  TO  5 
IF  ( PHI (2 ' .GE -0. . AND.DFSI .CE.0. -AND.ABSCUP  ).LT. ABSCUS ) )  GO  TO  I 
U  (PHI (2  ) . LE  .0. .AND. DPS  I .G£ .0. )  CO  TO  5 
If  I  PHI (2 1 . GE  .0. . AND.DPSI .LE .0. )  GO  TO  1 

IF  (PHI(2  i.LE .0. .AND.DPSI .LE .0. .AND. ABS(UP  )  .CT.ABS(U5 ) 1  CO  TO  1 
IF  (PHI  (2  ).LE  .0.  .AND.DPSI  .LE  .0.  .AND. AB5(UP).LT.  ABS(US)  )  CO  TO  5 

21  LPITE  (  G,  45  lF34!1AX,F23nAX,F  1 2nAX. FF D^tlAX, FF23nAX> FF laPlAX, PNMAX 
ATN.TINE 

OKITE(G,75)  ATN 

75  FORHaTC  the  SiA  APnS  IN*. 2X,F6. 3, 2X, ‘SECONDS. • ) 

STOP 


3550  0 

3560  C 

3570 

3560 

3590 

3600 

3610 

3620 

3630 

3640 

3650 

3660 

36  70 

3630 

3690 

3700 

3710 

3720 

3730 

3740 

3750 

3760 

3770 

3780 

3790 
3800 
3310 
3820 
;-3  3e 

3840 


22  FC-BHAT  (5F10.5) 

23  FOB NAT  (;hi,5/.2Hh*,Fi3.S,5a, cHB • . F 13 . 5, SX.cHC *,613.9, SX, 2HR *,613. 
15.SX,6Ha’.pha-  ,F9.4/  ) 

24  FCBfIAT  (3F10.5) 

as  FOBNaT  (1H  ,5X.6HEREST*,F5.2.3X.?HLAnBDA-.F8.3,3X,6HDELTA*,F8.3x) 

26  FCBNAT  (5E 12.5  ) 

27  FOBHAT  (IH  ,SX,4Hni  • ,  E  IS .  5.  3x,  4Ht12  •,E:5.5,3X.4HI13  •  .  E  1 5 .5. 3X  ,  4811 
14  < ,E 15 .5. 3X,4HnP  • ,E15.5/  ) 

28  FORHAT  (IH  ,5X,4Hn  • ,  E  IS .  5 , 3X,  4HI2  •  .E 15 . 5, 3X ,  4H13  •  ,E  15 . 5, 3X,  4HI 
14  •,E1S.5,3X,4HIP  «.E15,5/  ) 

29  FOPFIAT  (6F  10 . 4/3F10. 4  ) 

30  FCFNAT  (6X,5MRC1  •,F7.4,3X.5HRCP  • .F7.4 ,3X,6HRH0P  •,F7.4,3X. 
nx.7HPHIlC  •,F9.4.3X.8HPSICCD  • .F9 . 4, 3X,  6HPHID  -,F9.4//6X, 
25HPH1CUTD  •  ,F6.0/.'6X,  4Hnu  •  ,F5.3, 3X,5Hnui  *,65. 3x) 

31  FORT, AT  (3FIO.4/6F10.0/6F10.SX3F10.4) 

32  FOPNAT  (4F10.4) 

33  FORflAT  (6F10.5) 

34  FORNAT  (3F10.2) 

35  FCRNAT  (ih  ,5X,3AF5UBD1  • , F5 . 1 , 3X , 8HPSUBD2  -.FS . 1 ,3X, 8HPSUBD3  ".FS 
1  .  1/.'6X,5aNG1  ■,F4.0,3X,5HN&2  •  ,F4 . 0, 3X.  5HNG3  •  ,  F4 .0, 3X ,  5HNP2  .,F4. 
20,3X,5HNF3  -,F4.0,3X,5HNP4  • , F4 . 0x'6X, 8HC APRP I  ■ . F8 . 5. 3X , 8HC APRP2 
3-,Fa  .S.3X,8hCAPRP3  •  ,F8.5x/'6X,5HRP2  •  ,F8 . 5, 3X ,  5HRP3  •  .F8. 5 , 3X,  5HRP 
44  .,F8 .5/x6x,8MTHETAI  •,F8.3,3X,8HTHETA2  - ,68 . 3. 3X,8HTHETA3  *.68.3 
5/  ) 

37  PCRNAT  (6X,6HRH01  ■ , F7 . 5 . 3X . 6HRHC2  ■ ,F7.5,3X,ShRH03  • . F7 . 5, 3X, EHRH 
1C4  *,67.5' ) 

38  FORMAT  (6X.8HCAPRB1  - , F7 .5, 3X,8aCAPRB2  • ,F7 .5 , 3X,8HC APRB3  '.FT.S.B 
1X,5ARB2  •.F7.S,3X.5HRB3  *,r7.5.3X.5HRB4  -.FT-S/) 
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3ssa 

3S60 

3S7«i 

3SS0 

3890 

3900 

3910 

3930 

3530 

3950 
3960 
3970 
3980 
3990 
•4000 
■4010 
•40=0 
4030 
■4040 
■40S0 
<O£0 
•4  070 
4080 
4090 
4100 
4110 

4180 

4130 

4140 

4150 

4l£0 

4  170 

4180 

4190 

4800 

4810 

4880 

4830 

4840 

4850 

4860 

4870 

4880 

4890  C 

4  300  C 

4310  C 

4380 

4330 

4340 

4380 

4360 

4370 

4330 


3S  rCPflAT  (6X-,8HCPPR01  •  .r7.5. 3X,8HCAPR02  •.F7.5.3X,8HC0PRO3  ■.F7.6,3 
1X.5HR08  •,F7.S.3X.SHR03  •.P7.S.3X,ShR04  •.F7-5-'J 

40  FORMAT  (lHe,5X,4HJl  *  . ^ < -2. 3X.  ^ •  3< •  .F4 . £/ ) 

41  FORMAT  (SX.SHBETAID  •  , F7.8 , 3X , SHBETAaO  •,F7.2,3X,8t4BETA3D  •,F7.2,3 
IX,8HEETA4D  •,F7.2/) 

48  format  (5X.  14HCOUPLED  flOTION) 

43  format  i5x,11HFREE  MOTION//') 

4-1  format  (3HUP*,F8.3.3X.3HUS-.F8.3)  ^ 

45  FORMAT  ( IH0,6X, XF34NAX  •» .F6 . 2/ IH0,6X, »F23MAX  •» , F6.2/1H0 , BX,*F12 
IMAX  .t,FS.2/lH0.6X,»FF34nAX  .»,F6.2/lHe,6X,*FF23nAX  • t .F6 . 2/lH0,SX 
8»FF18nAX  •»,F6.2/lH0,6X.»PNnAX  •»,F6.2/) 

END 

subroutine  IMPACT  (PHI .OPHI.PSI.DPSI  )  ,  ^  « 

COMMON  A.P.C.R,ALPHR.PI,ZZ,ni,M2.M3,n4,nP.Il.I2,I3,I4,IP.EREST,LAn 
lBDA.DELTA,PHlTOT.PHrPR,H41 .N42,H43.0HEGA,0M2,RC1 .PHIIC.TESTI ,TeST2 
8. TEST3  NGl .NCa, NG3,NP2,NP3,MP4,CAPRB1,CAPRB2,CAPRB3,RB2,RB3,RB4,TH 
3ETA1,THETA2,THETA3,R1 , R2,R3. R4.RS.RH01 ,fiH02.RH03, RH04 ,RH0P, J1 , J2, J 
43.EETAl,B£TA8,BETA3,BeTA4,Dl.D2.D3,ALlIN.ALlFlN.J.TANG.NT. 

6AL2IN  aL2FIN,aL3!N,  AL3FtH,ALPHAI  .ALPHA2,ALPHA3.  IN,T2,T3,T4,nu,l1Ul , 
7PCP,PMC.Sl,£8.S3,S4,S5.Al.A2,A3.DPH12,DPSI2.F34nAX,F23nAX,F12l1AX. 
6FF34nAX,Fr23nAX.fF12nAX.PNMAX.PHICUTD.AA,AN.S6,S7,BD.RD. ID.MD 
REaL  11,  I2,r3.14.IP.LAMBDA.N41.N42.N43.IST0T,K 
ISTOT< 14* I HN41»N414l2»N42»N42«I3tN43»N43 
H«2. uBtCOSi ALPHR  l*AtCOS(PHl-ALPHR) ) 

<.A4l8*Btl8*9**2-C«»2*2.*B*R*SINCALPHR)42.>AtB»COS(PHI )-2.»A>RtSIH 

nPHl-ALPHRI 

C0NE«(-H»S0RT(H«t8-4.t»:  11/2. 

GTU0‘l-H-S0RT(HIta-4.lK  )  )/2. 

IF  (A8S(G0NE).LT.ABS(GTU0))  GO  TO  I 
G*GTU0 
GO  TO  8 
1  C'GONE 

£  aOn6 'B^COS*  AlPriR  i*G 

DONE'C«COS<PHl-ALPHR-PSI ) 

DPHIIN'DPNI 

DPHI-( IP»AONE»DPS:*ISTOT»DONE»DPMI+1P*AOME»£REST/DONEI(DPSI»DONE-D 
IPHITAONE  )  )/(IP»AONEI*2/DONE4lSTOT»DONE) 

DPS  I  • ( tPHI * AOnE-EREST* ( DPSI »D0NE-DPM1 INIAONE ) )/D0HE 

P)4IC*PHI/ZZ 

PSID'PSI^ZZ 

IF  (PHITOT.GT.30..ANO.PHITOT.LT.4PHICUTD-30.  ))  CO  TO  3 
WRITE  (G.4) 

WRITE  (6.5)  PHID.DPMI.PSID.DPSI.PHITOT 
3  RETURN 


4  FORMAT  ( IH0,SX,6m:MPACT) 

5  format  < IH0,18X,4HPHI*,F8.3,3X.7HPHI00T.,F8.3,3X,4HPSI»,F8.3.3X,7H 
1PSIDOT-.F8.3,3X.8HPHITOT  *.69.2 > 

END 

subroutine  FCT  CT.PHI.CPHI) 

COMMON  A,B.C.R,ALPhR.PI.ZZ,f41.M2.M3,t14,nP.Il,ie,13.I4.1P.EREST.LAn 
lB0A,DELTA,PHlT0T.FHlPR,N4i,M42.N43.0MEGA.0M2,RCj,PHIlC.TESTi.TEST2 


m 
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4  390 

4400 

4410 

4420 

4430 

4440 

4450 

44G0 

4470 

4480 

4  490 

4500 

4510 

4520 

4  530 

4540 

4550 

45b0 

4570 

4580 

4590  C 

4600 

4610 

4680 

4630 

4640 

4650 

4660 

4670 

4680 

4690 

4700 

4710 

4720 

4730 

4740 

4750 

4760 

4770 

4780 

4790 

4800 

4810 

4880 

4830 

4840 

4850 

4860 

4870 

4880 

4890 

4900 

4910 


2,TEST3,Nai ,NG2,nG3,NP2,NP3,NP4.CaPRB1 ,C0PRB2, CAPRB3,RB2.RB3.RB4,TH 
3£Tfil,THETrta,THETrt3,Rl,fi2,R3.R<.P5,fiH01,flH02,RH03,RH04,RHOP,Jl , ja.J 

43,BET01  ,BETP2.tiET03,BETA4.Dl  ,D2,D3,AU:lN,«LlFIN,  J.TttNC.NT, 
6PL2IN,rtL2FIN.AL31N,rtL3riN,PLPM01.A’uPHA2,A’LPHA3,  IM ,  T2,  T3 ,  T4,  HU,  PUl , 
7RCP.PSIC, SI .52,53.54,55,01 . A2,A3. DPH12, DPS! 2 , F34nAX , F23nAX, F lanAX, 
8FF34nAX.FFa3ilAX.Ff  l2nAX,PNf1AX,FHKUTD,AA,  AN,S6,S7,BD,RD,  IC.HD 
nnENSION  PHI(2),  DPHKa) 

REAL  «i,n2,ri3,n4.rip,ii,i2,i3,l4,iP.iiR,N4i ,N42,N4  3,nu,Mui.iPR.nD 

PHID-PHI V 1 )'2Z 

DELPHI -PHlD-PHIPR 

PHIT- (PhITOT*DELPHl )»22 

lN-1 

CALL  klNEM  (A.B.ALPHR.PHI ,R,C,C.P,0,S,GDOT,PSI,DPSI,AON£,BOnE,CONE 
l.DCNE,U,U,2) 


CALL  GCUROE'T.hA.AN) 

CALL  1 N3  ^  PH  I , PH ! T , OELPH I , GDOT , P5 1 , DPS I . AONE , BONE , CONE , DONE , AA 1 , AA 

12.AA3.AA4,AA5.AA6.AA7,AA8.AA9.AA10.AA11,AA12,AA13,AA14,AA15.AA16,A 
2A17,AA18,AAl9,AA20.AA21,Art22,AA23,AA24.AA25,AA26.AA2?.AA28,AA29,PA 
330,aa3: ,AA32.AA33,AA34.AA35.AA36,AA37.AA38,AA39,AA40.AA41.AA42,AA4 
43, AA44, AA45, AA46,AA47,AA48,AA49,AA50,AA5l. AAS2, AAS3 ) 


CALL  1 N  3A  ( A a54 . AASS , AA56 , AAS7 .CAPRB2 , MU , RH02 , AA5 1 , AA53 , 

*51 ,S2, A1 ,A2.S6,S7,AA49,AAS0,AA48,AA5a,Dl,RBE ) 

IF  (DP51«DPSI2.GE.O.  )  IPR*IP*AA15 
If  (  DPSUDPSie.LT.O.  )  lPfi*IP-AAl5 

IF  (PHl(2)lDPHl2.GE.0.  )  tlR*Il*AB5(nu>«RH01ltAA30*AA33) 

IF  (PMl(2)»DPHl2.LT.e.  )  nR*Il-AES<l1U)*RH01»(AA30*AA33) 

IF  i  IIR.LT.O.  IIR'O. 

IF  < IFP.L7.0,  )  1PR‘0. 

AAeS*AA25tlPRiU*AAn»14-AAlUAA22/(AA34*AA44»AA54  )» ( AA47»AA57tN41 
It! ip*aa34»aa54II3»N43-AA34*AA47»12»N42) 

AA59-AA1  4IAA2S»Ut*2*AA2S»lPR»U-AAll»AA22»AA37»AA47IAA57*N4lt*2 
'*/(^A34tA^44tAA^4  ) 

AA60'AHlllAA22MAA34J;AA44*AAS4»I(AA35»AA47»AA5“'AA34tAA47IAA55- 
1Aa341AA45IAA54 )*AA1 l»AA23*AA12tPA25-AA25»nP»RCP»SIN(PSl+PSIC )» 
as  INI  BET A4 )*AA25*nP*RCP*C0S(PSl*PSIC)»C0SlBETA4) 

AA6l*AAl llAA22/(AA34»AA44tAA54)J(AP36tAA47»AA57-AA34»AA47IAA66- 
1AH344AA46IAAS4  )*AAU JAA24* AAl3»AA25-AA25*nP»RCP»SlNlPSI +F51C  )» 
2C0SI SETA4  )-AA25*nP*RC°»C05lP51*PSIC)»SIN(HETA4  ) 

CPHKl  )-PHIi2l 

DPMI (2 )• I -AA59IPHI I  2 )l»2*AA60*AA*AA6l»AN)/AA58 

RETURN 

END 

SUBROUTINE  OUTP  ( T , PHI , DPHI , IHLF ,NDin, PRAT ) 

REAL  ni ,n2,n3,n4, HP, 11,12, I3.I4, iP,iiR,N4i.N42,N43.nu.nui ,lPR,no 
DinENSION  PHI(2),  DPHI(2),  PRnT(S) 

connoN  A.B.c,R.ALPHR,Pi,zz.m,ne,fi3,n4,np.ii,  12. 13,14. ip, erest.lah 
IBDA,  DEUTA,PHIT0T,PHIPR,N41  ,N42,H43,0neGA,  0112,  RCl  .PHIIC  ,  TEST  1  ,TEST2 
2,TEST3,NG1 ,NC2,NG3,NP2,NP3,HP4,CAPRBI .CAPRB2,CAPRB3,RB2,R83, RB4, TH 
3F.TAI  ,THETA2,THETA3,R1,R2,R3,R4,R5,RHOI.RH02.RH03,RH04,PhOP,J1.  J2.J 
43,BETA1 ,BfTA2,BETA3,BETA4.Dl,D2, D3.AL13N,AL1FIN, J.TANG.NT , 
6AL2IN,AL£F1N,AL3IN, AL3FIN.ALPHAl.ALPHA3.ALPHA3.IN,T2,T3.T4.nU,nUl. 
7RCP,PS1C  =1  .S2,S3.S4.S5,Al.A2,A3.DPHi2,DP5I2.F34nAX.F23nAX,f  lariAX, 
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•<922 

<930 

<9'<0 

■<990 

■49GO 

49T0 

<980 

<990 

SOOO 

5010 

5oac 

5030 

50<0 

5050 

50e0 

50?0 

5030  C 

5050 

5100 

5110  C 

SlcO 

5130 

5H? 

5150 

5150 

5170 

5  ISO 

5190 

5200 

5310 

5330 

5330 

63<0 

5350 

5330 

5370 

5330 

5390 

5300  C 

5310  C 

5330  C 

5330 

53<e 

5350 

5  360 

5370 

5380 

5390 

5<ee 

5<:8 

5<20 

5<30 

5<<0 

5<S0 

5<60 


SfF3<rAX,rFc3noX.CF13n0X,PNI1AX.PHICUTD,Aft,0N,S6,S7,BD,RD.ID.nD 
conroH  /2ETA/  Psi.Tine.G.DPSi.GP 
PHID*PHI( 1 1X32 
PEl.PHI*PHID-PHIPR 
PHIPR»PH1P 
PHITOT*PH!TOT-»9ELPHI 
PHIT.PHtT0T*22 
IM'O 

CALL  HINEl'i  ( A.  P.  ALPHR,PHl,R,C,G,P,O.S,GDOT,PSI  ,DPSI  .AOrsE.BOhE.COHE 
1  ,  DONE  ,  LI.  0,2  ) 

CALI  CCURlEiT.AA.AN) 

CALL  IN3  I  PHI .PAIT.DELPHI.CDOT.PSI.DPSI. AONE, BONE. CONE, DONE, AAl.AA 
.^A<,  AA5,  AA6,AA7,  HAS.  AA9,AA1C.  AAll  ,  AA13,  AA13.AA14,AA15.  AAie.A 
3Al7,  'iAlS,AA19,AAa3,  AA21  ,AA3a,AAa3.AA2<,AA25,AAa6,AAa7,AA38,AA39,AA 
330, Aa31 , AA33. AA33.AA3<,AA35.AA36,AA37, AA38,AA39,AA<0, AA<1, AA<2,AA< 
<3, AA<<, AA<5, AA46, AA<7, AA<8,AA<9.AA50,AA51 ,AA52,AAS3) 


CALL  :n3A( AA5<, AA55,AA56,AA57,CAPR83.nu.RH03,AASl,AAS3. 
<51 ,53,A1 .A2,56.S7,AA<9.AAS0, AA<8,AA53,D1.RB3) 


IE  lD?5I«DPSI3.CE.0. )  1PR*IP<AA1S 
IE  (  DP5  HD^Sia  .  LT.C,  )  IPR*IP-AA1S 

IF  'PHliaitDPHia.GE.O.  )  IlR*Il*ABSil1'J)»RHOll(AA30<AA33) 

IF  IFHI  la  uI'PHia.LT.O.  )  IlR.ll-ABStriU>tRHOU(AA30<AA33  ) 

IF  i IIR.LT.O,  )  I lR-0. 

IF  I IFR.LT.O.  )  IPR-0. 

rti-5a--AAa5*lFR«U<AAt  UI<-AAtUAAaa/(AA3<*AA<<*AA54)»(AA'<7IAA57tN<l 
1  1 1 iRtHA341AAS<« I 3»N<3-AA3<IAA<7tia»N4a ) 

AA55* AAl<IAAa5»UI*3<AA35»IPR«0-AAll*AAaa*AA37»AA4?tAA57IN4l»»2 

Aa£0* AAl 1 «AAaa' i AA3<«AA«tAA54 )»(AA35*AA47»AA57-AA34»AA47IAA55- 
1  AA(4>AA<'-.t>,A54  )«AA1 1  tAAa3+AAiaiAAaS-AAe5*nP*RCPI5IN(PSt<P51C  )* 
351NibLTA.<  j.AA35*riPlRCP»C0S(PSI<PSIC  )1C05<BETA4) 

AAC  f  AAl  1  triAaS--  (MA3<tAA«»RA54  )»(Ar.36»AA47*AAS7-AA3<*AA47tAA56- 
1  Aa:.<iA„<6«aa5<  i<AAl  1  tAAa<<AA13*AAa5-AAa5»nP»RCP»51N(P5I<PSlC  U 
3CC5(  BETA<  i-AA35jnPfRCP»C0S(PSI<PSIC  )*SIN(BETA4) 

DPHi.a*  (  -aa59«PhI  (2  )I*3<Aa60»AA<Aa6Uan  )/ AA58 
DPSi3'L»DPHi5*L*PHi  (a  uPHna ) 


COrP'jTATICN  OE  CONTACT  FORCES 

F3<- 1/ ( AA3<IAA<<<AA5< )*<  <  AA351AA47*AA57-AA3<*AA<7»AA55-AA3<»AA45* 
lft«54  ,.»PAi<(AA36»AA<7tAA57-AA3<*AA47»AA56-AA3<»AA<eiAA54  )»AN<AA371 
£.  AP47,fiP57*N<l»ia<PHI  (ailPHI  (2  )<(AA<7»AA57»N<l»nR<AA34»AA5<*I3IN<3 
3-AP3^ipft47iia*N<a  itDPHia ) 

Ae3. (PP4<tF3<*AA<5»AA+AP<6*AN-13»N<3«DPMIc )'AA<7 

E Ic*  <  AA5<»Ea3*AA55tAA*AA56*AN* ja»N<a»DPMie )/AA57 

IF  (F3<.GT.F3<nAX)  E3<NAX*F34 

IF  (Fa3.GT.Ea3nAx)  FasnAX'Fas 

IF  [Fia.GT.ElcrAXl  Pl3f1AX-Fia 

PN- ( - 1 <»  DPhI a*AAa2*F34<AP23»pA<AAa<»AN )/hAc5 

PNF<I*  ( IPPtDPSia<AAH*DP5IlDPSl-AAia»AA-AAl3*AN*t1P»RCP*lAAr(5lN( 
1PS1<P5IC)»5IN(BETA< )-C0S1 PSl ♦PSIC )»C0S( BETA< ) )*AN»(S1N< PSI<PSIC )» 
aCOS!BETA<  )<C0SCP5I<PSIC  )tSlN(BETA4  ) )  )  IXAAH 
IF  (PN.CT.PNHAX  1  FNHAX^PN 


S<70  C 

5480  C  TEST  FO*?  C OMT INUAT 10^^  CF  COUPLED  ROTTON 
549C  C 

S'^OO  IF  (  .NOT.  (G.LT  ,0,  ,F,ND.PN.CT.(J  .  )  )  PfiRT(5  i-e. 

5S;0  C 

5530  C  L'RITE  output 
5530  C 

5540  PSID-PSICZ 

C5S0  iF(j  Eo.j^;0oo»iooe)  go  to  so 

IF  ( PHITOT .GT . 30. .AND. FHI70T. LT. (PhICUTD-30. ) I  GO  TO  I 
65.0  50  URI'E  (6.?)  T ,  Ph]  D ,  PNI  !  2  : ,  G,  GDCT,  PS  D,  DPS  I ,  PMITOT ,  F34  ,F23,F  12,  PN,  P 

5580  1NP5I,1'FP12 

5530  1  TIRE-T 

6600  J-j*l 

$610  IF  (Phl^OT  .GE  .PmIC'JTD  )  PRRTIS)-!. 

5620  return 

5630  C 

fc  4  0  0 

w  ib>,3HT  '  ,  r  S  .  5 , 1 X ,  ShFH  I  • ,  F6 . 2 ,  i  A .  cH^H  I  DDT  •  ,  FG .  2  #  I X ,  3HG  *, 

5660  iFP.^.lX'.fcHGDOT  • ,  F  4 . 2,  :x  ,  6nrs  I D  • ,  FT  .  2,  ix,  3MPS1  DOT  . ,  FS  .  2,  IX,  ShPHI 

P670  ,-TOT  •  ,63. 1 'OCX,  SHF  34  • ,  F  6 . 4 , 3X ,  SHF23  •  ,  F6 . 4 , 3X ,  SHF  1 2  • ,  F6 . 4, 3X ,  4HP 

5680  3r(  •  ,F6. 4,  3x,VHPNr  5!  •,FG.4,3X.7H0Ph:2  •,E12.4-'/) 

5630  END 

5700  iUERCUTlNE  FCTf  (T,X,Dx> 

5710  CORRON  P, S ,C ,R.PLPHP,P] . ZZ,RI , R2, R3,R4, np, 11 . 1 2, 1  3, 1 4 , IP.EREST , LAM 

5  720  1  3 DA  I  ELTh.PHITOT,  PHIPR,N4  1  , M42 , H43, CPEGA . 0612 , RC 1 , PHI  1C , TESTl , TE5T2 

57^0  e, TesT3,NGl ,NG2,NC3,NP2,NP3,NP4,CAAP91 .CAPRB2,CAPRB3,RB2,RB3,ftB4,TH 

5740  3ETh! .THETA2,Th£TA3,R1 ,R2,R3,R4,R5,RH0l ,RHO2,RH03,Rh04,»H0P, J1.J2, J 

5750  43,BETAl,t)ETA2,B8TA3,BeTA4.Dl  ,D2,D3,ALUN,AUIFIN,J,TANC.NT, 

5760  6AD2IN,AL£F  It),  Al.3  i  N ,  AL3F IN,  ALPHAl ,  ALPHA2 ,  ALPHA3,  IN, T2, T3,  T4 , MU.MUi , 

57'0  7KCP,PSIC,Si,52,S3,S4,S5,  A:,A2,n3,DPHl2,DPS!2,F34RAX,i-23'1PX.F12f1PX. 

5780  bFF  34RAX,FF23RAX,FF 12RAX,PNMAX,PH1CUTD. AA, AN, 56,S7,BD,R0, ID.MD 

5790  DIMENSICN  X(4),  DX(4l 

5300  COnnOH  /ZETA-  PS! ,TIRE,C,DP51,GP 

5810  PEAL  Rl,R2,R3,n4,MP, 11,12,13. 14, IPR, HR, RU.nul,N41,N42,N43, IP, no 

5820  PHlD'Xni/ZZ 

5S30  DELphI-PhID-PHIPR 

5340  PH1T.(PmIT0T*DELFHI )»ZZ 

5850  [N-1 

5860  CALL  CCUROP I T, AA,AN ) 

5870  CALL  IN3  (X, PHIT, DELPHI. 0.,X(3),X»*).B..e,.0.,0.,AAl,AA2,AA3.AA4, A 

5830  lAS.AAS. AAV, aa8,aa9,AA10,AA11,AA12.AA13, AAl4,AAl5.AAie.AA17,AAl8,AA 

5890  219 , AA20, AA21 , AA22 , AA23, AA24 , AA25, AA26, AA27, AA2B, AA2g, AA30, AA31 ,AA3 

5900  32,  AA33,AA34,AA35,  AA36,aA37,A.A38,AA35,AA40,AA41,AA42.AA43,AA44,AA45 

5910  4,AA46, AA47, AA4B, AA49, AA50.AA51 ,AA52,AA53 ) 

5920  C 

5930  CALL  IN3A  (aA54,Aa55, aa56,aa6/,CAPRB2,RU,PH02,AA51,AA53. 

5940  *51 ,S2,A1, A2,5b,S7, AA49, AA50,AA48,AA52,Dt,RB2) 

5950  C 

5960  IF  <X(4  i*DPjI2.OE.0. 1  IPR*IP  +  AA15 

5970  IF  (XC4 ;iDPSI2.LT.e. )  IPR*IP-AA1S 

5980  IF  ( X(2 )»DPhI 2.CE . 0 .  »  I IR • 1 1 ♦ aBSIMU ) IRHOl » < AA30*AA33 ) 

5990  IF  <XC2)*OPhI3,LT.0. )  I IR-I l-ABS(nu )*RHO I I ( AA3**AA33 ) 

6000  IF  ( I1R.LT.0,  )  IlR-0. 

6010  IF  <  ir'P.LT.0,  )  IPS-e. 

6020  IF  ( :FR.EQ.0.  1  UPITE  <6.1  ) 


6030  I  )»(AA3S»004?»ftfl57'AA34»aft47»««55- 

6040  ♦4034»rtfl45tAAC4 ) ♦«« 1 1 tfl«a3* AA 1 2*AA£S-AA25*nP»RCP»SIN ( PSl ^PS IC )* 

£050  *5  INIPETA4  )+AAc5»r!P»HCPtCCS(PSI*PSI0  )»C05(BETA4) 

£060  AAGl  •AAmA«a2^(AP34lAA44lAA54  )t(AA36*AA47IAAS7-AA34f  AA47»AAS6- 

6070  «AA34»AA46*AA54  )*AA1  UAA24*AAl3tAAa5-AAa5tnP)lRCP*SlNtP5I*PSIC)» 

6060  +005 , 6CTA4  i-AA2S»nP»RCPtC0S<PSI*PSIC)»SimBETA4) 

6050  AA6a • 1  PR 

6100  AA63.Artl2-nPtRCPt(51NiPSl4PsrC  )tSIN( BETA4 >-C0SlPSl*PS IC >»C0S ( 

6110  1EETh4)) 

61  £0  AA64-AA1  3-rP».KC?l(5lNiPSI+PSlC  )»C0S (  BeTA4  )-C0S  I PSI  +  PS  IC  )*S1N( 

6130  1BETA4I) 

6140  AA£5-;4-AAa2  i AA34»AA44*AA54  H ( AA47»AA57IN4 1 » I 1R4 AA34 I AA54 » I 3t N43 

61P0  l-AA34lMA4'’»!2th42) 

6160  AAE6--AA2atAA37tAA4  7«AA57th4Ut2/(AA34«AA44tAAS4) 

6170  AA67«AAa2-  1 AA34*AA44tAAS4  J»( AA3S*AA47tAA57-AA34*AA47»AAS5-AA34t 

6160  1  A A4^ t mm5 4  )  4 AAa 3 

6130  AA6S- AA22  lAA34*AA44»Afi54)»<AA36*AA47*AAS7-AA34IAA47lAA56-AA34t 

6200  14A46IAA54  )*AA24 

6210  P  V  M  '  •  Ki,  2  > 

6"'0  D';i3>'M4) 

6231,1  ;i,\i2  !•  (AA67«AA4AA68*AN-6A66*X(2)»»2)/AA65 

6240  D>i<4  l>(AA63tAAiAA64tAN-AA14<X(4)tta)/'AA£2 

6250  RCTURM 

6260  ■: 

6270 

62S0  1  PORnOT  (4OH0IPR  EQuAtS  ZERO  -  SIHUlATION  TERlIINATEO) 

6250  EHP 

6300  SUEPOUTIME  OUTPF  ( T , X, DX. IHIF .NOlM.PRnT  ) 

t.3io  i.onnuN  a,  B ,7 ,  r.alphp. PI  .zz.ni  .na,n3,ri4, np, n , la,  13.  M,  ip.erest.lah 

6  320  1 B  DA,  DELTA,  Ph  I  TOT,  PH  I  PR,  N41  .M42,rM3,0HECA.  Ona.RC  I,  PH  lie,  TESTl  ,TE&T2 

6330  2,TE573,HC! ,HC2,NC3.NPa,HP3.HP4,CAPRBl,CAPRB2,CAPRB3,RB2,RB3,RB4.TH 

6340  jETAI ,THeTA2,THETA3,Rl,R2.R3,R4,R5.RH0l.RH02.RH03,RH04,RHOP, Jl,J2,J 

6350  4.I.BETH1  ,  tETA2,BETA3.  BETA4.  01 ,02,03,  ALl  IN.ALIFIN,  J,TAMC,HT, 

6  360  6HL2!ri,  Al,2f  IN,  AL31N,AL3FIN,ALPHA1,ALPHA2,AIPHA3,  IN,T2,T3,T4,nu,nUl , 

6370  rPCP,P5IC,Sl  ,52,S3.S4,S5,Al,A2,A3,DPHI2,I>PSia,F34«AX.Pe3nAX,Pl2nAX, 

63B0  8Ff341AX,PF2jnAX,FFi2nAX,PNnAX,PHlCUTD,AA,AN,S6,S7,BD,RD,  ID.nO 

6390  PEAL  ni  ,f!2,n3,n4,r.P,  11,12, 13.  l4.IP,IIR,N4i,N42,H43,ru,nui.I.«>R,nD 

6400  DintNSiON  XC4 ),  ox(4),  PRnns) 

6410  COnnON  /ZETa/  PSI ,TinE,G.DPSI,GP 

6420  PHID-X( 1 J/Z2 

6430  P5ID-X(3)^zz 

6440  DELPHI •PHID-PHIPR 

£460  FH:TOT*PHlTOT*tELPHl 

6460  PHIT.PHITOTIZZ 

6-170  PHIPR-PHID 

6420  IN»0 

6490  CALL  CCLROE(T,AA, AN ) 

6500  CPLL  IN3  ix,Pm:T,DELPHI,0.,X(3),X14).0.,0,,0,.0.,AAI,AA2.AA3.AA4,A 

£510  1AS,AAG,AA7,AA8,AA9.AA10,AAI 1 , AAie, AAl 3. AAl 4 , AAlS , AA 16 , AA17 , AA 1 8. AA 

6520  219.AA20,AA21, AA22,AA23.AA24,AA25,AA2S.AA27.AAa8,AAa9.AA3e,  AA31,AA3 

£530  32,AA33,AA34.AA3S,AA36.AA37,AA38,AA39.AP40,AA41,AA42,AA43,AA44,AA45 

6940  4,AA46. AA47,AA48.AA49.AA5B,AA51,ftA52,AA53) 

6553  C 


100 


CALI  :h3a  (  A(i5<,AAS5.AAS6,AA5?,CAPRBa,nu.RH0a,AA5l,  AA93, 
♦  Si .  f5, A1 , A3,S6,  S7,  AA4g,AASe, AA4  8, AASa, [1,882) 


esso 

toSSO  c 
DbOO 

bb  1  0 
bo^O 
tboV,' 
tb*^0 
ci>^0 
t-  b  t  l' 

6 

DC-  ,• «. 

b  I 
b  I  30 

b?A0 

bTSO 

D  '  b>0 

b7  ro 
63  30 
6790 
fSOO 
6810 
fcSaO 
6330 

bS40 
fatso 
6360 
C670  C 
ctoO  C 
fas-so  c 

6900 

6910 

6520 

6930 

6940 

6950 

6560 

6970 

69S0 

6990 

7000  C 

7010 

7020  C 

7030  C 

7040 

7050 

7060 

7070 

7030 

7090 


ir  i>,(4  )»??SI2.0l.0.  )  IPR*IP*6h15 
IF  t x; 4  ilfPS 12. LT.O. )  IPR-IP-AA15 

:F  1  V(b  ItDPHie.GE.O.  )  IlR*IlbABS»l1U)»8HCl»(AA30  +  AA33) 

;f  ( x ( '  )  tD=H 12 . LT , 0 .  )  I IR* I  1 -ABS( Mu )tRH01 1 ( AA30  +  AA33 ) 

IF  (  I1R.LT.0.  )  IlR-0. 

IF  ; IPR.LT.O.  1  IP9-0. 

,5Ao  ''*AA1  1  I^A22' 1  AA34tAA444  AA54  l«  (  AA35»AA47»AA57-AA34tAA47tAA55- 
.bM34iAA4SiAA5  4 i.ha: l*AA23<AA12»Ab25-AA25fnPtRCP»SIN(PSl  +  P5!C  it 
‘f  IM'  FE''’A4  .'*Art25tF:’tRCP*CC'SiPSI*F5lc  )tC0SiBETA4  1 
AAfal  •  iiA;  1  tAA22^  i  AA34tAA4  4|AAS4  )ttAA36»AA47tAA57-A6341AA47»AA96- 

♦  AA741AA4faiAb54  !»AA1 llAA244AA13tAA25-6A25tnP*RCP*SlM(PSI*PSIC  >* 

♦  CO-'.'  FET.h  ;-MA£5tnP«RC?lCCS(P51*PSIC  )tSIN(  BlTA4  ) 

AAitjc'IPR 

(  sih,(PSI^PSlC  i  tS  I N I  BETA4  ) -COS  I  PS  I  ♦  PS  IC  IICOSI  BETA4 

1  '  ' 

H..64-HH1  3-MPiRCPt  tSIN(PSI*PSlC  itCOSi  B6TA4  )-COS(PSI»PSIC  ItSINt  BETA4 

1  '  1 

1  4-AA22/  (  P,-04IAA4  4»AA54  )  1  (  AA  47*  AAS7»N4 1 1 1 1  R  + AA  34  »  A  A5  4  *  I  31N43 
1  -  ►A  '  4  I  ^4  4|  7  I  I  t  N  4  (3  .* 

Pwbfa. .prt22IAA37tAA47tAA57tN41lt2/( AA34tAA44*AA5A ) 
ftPS'.puCJ/ r  «a34tcA44l6A54l'  ( AA35t AA47»AA57-AA34tAA4  7tAAS5-AA34t 
lPH45tA6S4  i*mA23 

wA6S ’bH’t  i AA34tAA4  4tAA54  )  t ( AA36»AA47 1 AA57 - AA34*AA47t AA56-AA34» 
;hA46»AAS4  ;  »AA?4 
F  S  I  •  *  '  .1  I 

DPS  I  •>.  1  4  * 

D Ah  1 2 • I  - HAbfalX ' 2  I  IK l2 )*AA67tAM*AA68»AN I/AA65 
DFClt*  -AA14IK( 4 )»XI 4 )+AA63*AA«AAS4»AN I/AA62 

COnPuTATlCN  Of  CONTACT  E0RC6S 

fE34-  !4IOPH;2-AA23»AA  +  AA24»Af1)/AA22 

FF23* ( AA44frF344AA45»AA*AA46»AN-I3*N43tDPHI2 l/AAA? 

FF 12' ! AA54 IF F2 3* AA55IAA^ AA66IAN+ I 2»N42lDPHl 2)/ AA57 
IF  (FF34.CT.FF34rAX)  FF34nAX-Ff34 
IF  lFF23.CT.FF23nAX  )  FF23nAX*FF23 
IF  (FFlE.CT.FFlcnAXl  FF  l2r4AX»FFl2 

:f( j.Eo.j/ieoetiooo)  go  to  50 

IF  (PHITOT. GT. 30,  .AMC.PHITOT.lt. (PHICUTD- 30.  )  )  GO  TO  1 
S0  uRITE  (6,4)  T,AHtD,X(2  ),P5ID.X(4  ), PHITOT. fF12,FF23,FF34 

1  IF  (T. EG. TIFF)  CO  TO  3 

J- J*1 

CHECK  FOR  CONTINUED  FREE  flOTION 

F-AISIN(X( J  )-ALPHR )-B*SIN(ALPHR)-C*SlN(X( I  )-ALPHR-PSI  )-9 
GP-C»C05'X( i ;-ALPHR-PSl )-B»COS(ALPMR )• AiC05( X( I  )-ALPHR  ) 

IF  (F.G''.0.  )  GO  TO  £ 

PRMKS  I'c. 

GC  TO  3 

2  IF  (GP.GT.0.)  i'RHTiS)«2. 


TlOC  3  TI^IE-T 

7i;0  IF(PhITOT.GE.PHICUTD)  PRATCS)-!. 

7i;0  RETURN 

7130  C 

71  JC-  C 

7llo  <  FORriPT  (eX.3HT  • ,  F8 . 5. 3X,  SHPHi  • ,  F7 . 2,  3X .  8MPHI  DOT  •  ,  F7 . 2 , 3X ,  SHPSI 
71-0  1- ,F7,a,3X.8HPSI00T  ■.F8.2.3X.8HPHIT0T  • . F9 . 2/20X, SHFF 1 2  •,F7.3,3X, 

TlSO  ♦EHFFaa  •,F7.3,3X,6HFF34  •,F7.3//) 

7190  EtiT 

7200  Subroutine  kinen  (a,b,alphr,phi,r,c,g,p.q,s.cdot.psi,dpsi.aone,bon 

7210  1E,CCNE,D0NE,U,U,2 ) 

7230  DinEHSICN  PHI (2  I 

7230  PEAL  K 

7240  PI»3.M199 

7250  H-2.tiB*C0Sl ALPHR  )+A*C05(PHI< 1 J-ALPHR)) 

72b0  K.A»A*P»B-*RtR-CIC  +  a.*B»R*SIN<ALPHR)*2.»A*B*C0S<PHI(  I  )  )-2  .  *AtR*SIN( 

7270  IPHI ( 1  )-ALPHR  ) 

72S0  GONE ■ I -H«SGRT(H»H-4. *X ) )/2. 

7290  GTUO- i -H-bOPT (HlH-4 . tX ) )/2. 

7300  IF  1 AP5(G0NE  )  .LT.ABS(GTUO) )  GO  TO  1 

7310  G-GTUO 

7320  GO  TO  2 

7330  1  C*GON£ 

7340  2  P-BlSIUlPHl  (  1  :  )*G*SlN(PHl  (  1  )-ALPHR  UR»C0S(RMI<  J  )-ALPHR  ) 

7350  0'P>00? IPh! (  1  )  )4G*CCS(PHI ( 1  ) -ALPhR ) -RxS lN( PHI < 1 )-ALPHR ) 

7360  S*G‘EiCOS' aLPHR)*asC0S(PHI(1  )-ALPHR) 

7370  GPnT.PHl i 2 J»A»P/S 

73S0  P5I«ASIN[P/C  ) 

7390  IF  lF«I .LT.0.  )  CO  TO  3 

7400  CO  TO  4 

7410  3  Pil *2 .xPI -ABSiPi I > 

7420  4  DPSlMOtPHliaiTGDOTISINCPHKl  )-ALPHR))/<CtCOS(PSn) 

7430  AONE«BfCOS( ALPHR )4C 

7440  EONt'PtSINtALPHR) 

74  50  CONE--(fi*CtSIMlPHl I  I  l-ALPMR'PSI  ) ) 

7450  DONE*C«COS(PHI( 1 1-ALPHR-PSI > 

7  470  2" (0*AlP/S*SIN(PHI ( I  I-ALPHR  )  )/(CtCOS{PSI  )  ) 

7430  U‘ (0*SIH(PHI( 1  ) -ALPHR )»PXA/S  )/ < CICOS ( PS  I ) » 

7490  U  -  (Q*A*PISIN(PHI(  I  :-ALPHR)/S  )»*2*TAN(  PS  I)/ tC*t2t  ( COS  ( PSI  )  )lt2U(  V. 

7500  1/(C*C05(PSI  1  )  )*(2.»A»P»C0S<PHI(1  )-ALPHR)/S-P»2.»A**2*P*(SlN(PHI(  1 ) 

7510  2-ALPHR) JII2/5**2*A»Q»SIN(PHI(1  )-ALPHRI/S-A*»2lP«t2«5IM<PHl<l )-ALPH 

7520  3R)^S»*3) 

7530  return 

7540  END 

7550  SUBROUTINE  IN3  ( 2ZZ , PM  IT , DELPHI ,CDOT, PS  I . DPSI .AOHC. BONE, CONE , DONE . 

7660  lAAi,AA2,AA3, AA4,flA5,AA6, AA7, AA8,AA9,AAie.AAll,AAl2, AAt3, AA14,AA15, 

7570  2AA16, AA17, AAlB.AAig, AA20,AA2l ,AA22,AA23.AA24,AA25,AA26,AA27,AA28,A 

"530  3A2S,AA30,  AA31 , AA32,AA33,AA34,AA35, AA36,AA37,AA38,AA39.AA4e,AA41,AA 

7590  442,AA43, AA44, AA45,AA46.AA47. AA48,AA49.AA50.AAS1,AA52,PAS3) 

7600  DlnENSION  Z2Z<4) 

7610  COnrON  A,  B,C,R,  ALPHH.PI  ,ZZ,N1  ,»12,n3.n4,np.  II,  12, 13,  I4,  ip.erest.iah 

7620  1BDA,DELTA,PHIT0T,PHIPR,N41  ,N42,H43,0l1ECA,0n2,RCl,PHIlC,TESTl,TEST2 

■’6  30  2,TeST3,NGl  ,NG2,NG3,NP2,NP3,NP4.CAPfiBl,CAPRB2,CAPRB3,RB2,RB3,RB4,TH 

76  4  0  3ETA'  THETA2,THETA3,Rl,Ra.R3.R4.RS,RH01.RH0B.RH03.RH04,RH0P, J1,J2, J 


■?bSO 

43.BETi^l.BET0e.BET(^3.B£TO4.Dl.D2.O3,eLllN,ALlFlN  J.TftHC.NT 

'.V.- 

6AL21N,-^UcFlN,0L3lN,01.3FlN.fll.PM01  .<»LPHft2,ALPM«3.  lN,Te,T2,T4,rj  rui , 

7670 

7RCP.FSIC,61  .Sa.S3.S4,S5,Al,A2,  A3.DPN12,riPS12.04«AX,F23f1AX.F12.iAX, 

^63e 

OFP34n^X.PP23MAX,Fri2NAX,PNriAX,PHlCL'TD,  AA,  AN,S6,S7.B0,fiD.  ID.  HD 

7690 

REAL  Mi,n2,n3,r4,np.nu,Hui .h4i,n42,h43, ii. iir.nd 

|C' 

7700 

PHI-22Z(1 ) 

7710 

DFHl-2Z2t2) 

7720 

IF  <  CPHI .EO.0.  )  60  TO  1 

7730 

nu*Ap?(nu )»dphi/a8S<dphi i 

*.•  ' 

77^0 

1  IF  (IM.EQ.0)  GO  TO  2 

N 

7750 

C 

* 

7760 

C 

L'FDATE  OALUES  of  alphas 

*.  __ V 

7770 

Q 

7’’S0 

DELAL3-DELPHIt22 

Ik 

7790 

rELAL2«D£LAL3*RB3/CAPRB2 

7800 

BELAll •D£LAL2»RB2/CAPRB1 

V  *  ♦ 

7910 

ALPHAl ■AlPHAl+DELALl 

7E20 

ALPHA2* ALPHA2+DELAL2 

7930 

ALPHA3*ALPHA3*DELAL3 

•  * 

7S40 

IF  (ALPHAl .GT.ALlFlh)  ALPHA1*ALIIN 

7850 

IF  i ALFmA2.GT . AL2FIh  )  ALPHA2-AL21N 

7860 

IF  (ALPHA3.GT.AL3FIN)  ALPHA3-AL3IN 

7370 

C 

ar 

7SS0 

C 

DETERriNATlON  OF  SICNUHS 

7390 

c 

.**  fc*' 

7900 

2  If  ( ALPHAl .LT.TESTl  )  Sl*l. 

7910 

IF  (ALPHA2.LT.TE5T2)  52«1. 

7920 

IF  ( ALPHA3.LT.TEST3  )  53*1. 

7930 

IF  ( ALPHA  1 .GT. TEST n  Sl*-1. 

79<0 

IF  (ALPHA2.GT.TesT2)  S2*-I.. 

7950 

IF  (ALPHA3.CT.TEST3  )  e3‘-l. 

»  •  • 

7960 

IF  (ALPHA! .EQ.TESTl )  51*0. 

7970 

IF  (ALPHA2.EQ.TEST2 )  $2-0. 

1 

7980 

IF  (ALPHA3. EO. tests  )  53*0. 

7990 

IF  (CDOT.HE .0. )  GO  TO  3 

; 

8000 

54.1. 

8010 

GO  TO  4 

8020 

3  54-GD0T/ABS(CD0T) 

8030 

4  IF  (DP5I.NE.0. )  GO  TO  5 

8040 

55*1. 

3050 

GO  TO  G 

m 

8060 

5  SS-DPSI/ABSIDPSI ) 

8070 

6  IF  (AA.NE.0. >  GO  TO  7 

8080 

56.1. 

8090 

GO  TO  8 

»  .*• 

8100 

7  S6.-(AA/ABS<AA) ) 

8110 

8  IF ( AN.NE.0. )  GO  TO  9 

8120 

$7.1. 

v*.*. 

8130 

GO  TO  10 

» ■ 

8140 

9  S7.-(AN/ABS( AN) ) 

mL 

8150 

10  CONTINUE 

8160 

c 

8170 

c 

•  *  .• 

8180 

c 

COfIPUTATION  OF  A1,A2  AND  ft3 

615(5  C 
6200  C 

S210  i^l*ALPHrtl»CflPRBl 

S220  rta*rtl.PHAStCflPRBe 

S<E30  «3*ALFHi»3»CPPRB3 

DEhOn*! 

6650  DENoni-1 . ♦nuiinui 

8250  PI-3.14159 

Fa~o  c 

3280  C  COnPUTATlON  OP  AAl  TO  AA57 

£?90  C 

6300  AAl-ABSC  (nUll(S4-S5  J»StM(PHI-ALPHR)-(  1  .♦S4»S5lf1Ul*l1Ul  )ICOS(PHl-ALP 

8.-10  IHPD/DENOnn 

Sr-cO  AAa-A6Sil1P*(C0S(BETA4  )-f1Ul»S5*SIN(BETA4  )  )  l/DENOMl 

6330  PA3-AFS(nPtiSINlBETA4 )-«Ul »S5*C0Si BETA4 ) ) l/DENOMl 

3340  Aa4.aBS>  (nP*RCP«(StM<PSI+PSlC  )-l1Ul»S5»C0S(  PS  I  *9510  )  ))/DEMOI11  ) 

6350  AA5-AB51 tnPtPCP»(COS(PSI*PSlC )*nui»S5»SIN(PSI ♦?$ IC ) ) )/DENOI11 ) 

8360  Aa6*AB5(  iflUlK  S4-SS  J*COS<PhI-ALPHR)»(  1  .♦S4lS5*nUlII1Ul  )  «SIN( PHI -ALP 

S3'’0  IhR  )  i/fENOni  ) 

3330  AA7-ABS(fiP»(riij:»55*C05(BETA4  )  +  SIN(BETA4  ) )  )/D£NOm 

6350  HH2*HB5(MP»(flUl*S5*SIN(BeTA4  )tCOS(BETA4)  I  )/DENOMl 

S4C0  HA3-WB5I  ( nP»RCP»(COS(PSI*PSIC )4nui»S5ISlN(PSI*PSIC )))/DEH0ni ) 

8410  A«10.  ABS(>nPtRCP»<SIN(P5I+PSIC)-nui»S5»C0S(PSl4PSIC))  l.'DENOri  ) 

E4£e  mAU-DONE  ♦CONEiHUl  lS4-RHOP»t1Ut*S5»(AAl+AAe) 

8430  MAia-i6lRH0Pt(1'Jl»SS»(  AA2+AA7  ) 

344  0  AA13-S7*RM0P1(1U1  tS5»(  AA3*AA8  » 

3450  A«14.RHOPtPIUHS5l(AA4*AA9) 

8460  AA15>PHOP«nUt  t  (  AAS-^AAie  ) 

3470  AA16«AB$V I -(nuUS4-MU)*SINtPHl-ALPHR«BETA4)4(J.+nu*nui»S4)iC0StPHI 

8480  1-ALPHP4BETA4  )  l.'DENOn  I 

6450  AAl7.AgS( inu*( 1 .-S3  >ISIN<B£TA3»THETa3  »♦ ( I . ♦nu»nU»S3 IICOSC  B£TA3»THE 

6500  lTA3))/DENOn) 

6510  Arti8*ABS(  n4/t)EN0n ) 

65S0  aa19-0BS(  flL)»n4/0EN0(1) 

8530  AA20.ABSn  ( l.*ruinuilS4  )*SlN<PHI-ALPHR4BETA4)4(S4*l1Ul-nU)»C0SCPHI- 

6540  lALPHR4bETA4  )  )/0EN0n ) 

8550  AA2l  •  ABS(  (  -  ( I .  •Kiu*r,U»S3  llS  tN(  BETA34THETA3  )4nu*<  1 .  -S3  )ICOS  (  BETa3*TH 

8560  1ET03)  j.'DENOfl) 

8570  AA22-RB4-nU»(S3I(D3-A3)4RH04I(AA17*AA2l >) 

8580  AA23-nu»RH04tS6l(AA184AA19) 

8550  AA24.n’J*RM04IS7l(  AA184AA19) 

8600  AA25-A0NE*B0NE*MUl»S4+nU*RH04Ji(  AA16tAA2e  ) 

8610  AA26-ABS(  (nut(  l.*Sl  )«SIN(BETAX*THETAJ  )- (  1 . -flUtllUtSl  llCOSIBETAl  ♦THE 

6620  ITAI ) )/DENOn  ) 

8630  AA27.ABS(ni/DENOf1) 

6640  AA£8-ABS<m»NU/DEN0n) 

8650  AA2g«ABS<  ( n UPC  1  f  ( HUtCOSl PHI  IC*PMIT»N41  )4SIN(PHI  IC+N4UPHIT  ) )  )/DEN 

8660  loni 

8670  AAjO.ABSC  (ni»RCU(C0S(PHnC4N4l*PHITl-nU»SIN(PHnC*N41»PHIT  ) )  )/DEN 

8680  lOfl) 

8690  AA31>ABS( ( (l.-nu*nutsi )*SIN(BETA1*THETAI )*nut(l.*Sl HCOSIBETAI^THE 

S70O  ITAin/DEMOU) 

8710  AA32>AB5( (niIRClt(C0S(PHriC4Ml*PHlT)-nU»SIN(PHllC*N41lPHlT)) l/DEN 

6720  1011) 

8730  AA33.ABS(  (nuRCl«(SIN(PHIlCtN4l»PHIT)*r.U*C0S(PHllC*N41IPHlT  ) )  )/DEN 
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S740 

«?'^C 

S7T0 

37S0 

3790 

3S10 

S33k' 

bS20 

3~-0 

S85e< 

SS6v' 

8S70 

SSSO 

3S90 

3300 

S910 

S3<30 

8530 

8540 

S950 

3530 

£3'0 

8930 

8950 

90CO 

9010 

9020 

9030 

9040 

9050 

9060 

9070 

9080 

9090 

9100 

9119 

9120 
9130 
9140 
9150  < 

9169 

9170 
9180 
9190 
9200 
9210 
9220 
9230 
9240 
9250 
9260 


ICn  I 

fiA34'C«PRBl-nu»Sl*01*nu»RW01»«AAa6*«A31  ) 


AA3S  ANn  AA3b  REOlSeC  TOP  patriot  ni43  Sift 


ftft35-S6»nu*RH01»!  aAc7*AA23  )*f11  IRC  1  »C0S<  PHI  1  C*N4  1  tPHlT  ) - !1D*PO*C05 ( 

♦  FD+PI  ■■*  .  -N4UPHIT  ) 

ftft.lb*;  7*ru*RH01*  (  ftft27*ftAa8  )-!11  IRC  1  *SIN(  PHI  1  C*H4 1  *PHI  T  )  ♦rtDtPDtS  I  N( 

♦  tD‘C 1  4 . -N41 IPhI T  ) 
ftft37*-fl0tRH01iiftrt29*ftft32  ) 

t  (  1  .  ♦•^L'lMUISa  IIC0S(8ETA2-THETfta  )*?1UI(S2-1  .  )tSIN(BETA2-THE 
lTft2i'  DEHOni 

^rtuirs^DENOM  ) 

Hft4v'  =  HB4 1  n3/  DFHOn  ) 

ftft-t;  •ftpsm  1  .  -nuinjIS3  )»C0S(BETA3*THETft3)-nct(  1  .+S3  itSIN(  BETA3*THE 
lTft3  1  )  DEh07  ) 

ftH43‘ftB3( K 1 . ♦nu»nu»52 )tSlN( BETAa-THETfte  )  +  nu*( 1 .-S2  HC05 ( BETfta-THE 
1Th2  '  )  -DENJ.1  ) 

►iH4j-ftB3i  (  I  1 .  -noif1UtS3  )*S1N(  BETA3*THETA3)4nut(  1  .  *53  )IC05 1  BETA3»  ThE 
lTft3  I )  DtMOl ) 

MH-i4-CHpRB3-n'j«S3tft3*nLltRH03»(AA4i  ♦AA4  3  > 
hh45-  -nL!lfiHC3»36*(  AA39  +  ftA40  ) 
ft44b*  -rlJlKHO3«57I<AA39*AA40) 
ftft4?.RB3-nut( S2» ( D2-ft2  URhOSI I AA38*ftA42 ) > 

ftft4a*MpSi (nUK 1 .-SI  ) IS  IN ( BET A1 ♦THETA! )♦( 1 .♦rUIHUISl  )»C05 ( BETA  1 ♦ THE 
iTftl  )  PENON  ) 

AA49*AP5ir2/DEN0ri ) 

PA53<ftB5iN'J».'12-'DEN0P  ) 

AASI-mBSi (nuK 1 . 452 )ISIN(BETA2-THETA5)*( 1 . -nui5U*52 )tC0S ( BETA2-THE 
1TA2  I  i^DENOn  ) 

HA52-ftBS( (NUK 1 .-51  Jf^AS(BETAl+THETAl )- ( 1 . ♦nUldUISl )»SINt BETAI  ♦THE 
iTftl  )  ).-DeNOn  ) 

Ah53-ABS( ( ( 1 .-P1UinuiS2)ISIN(8ETA2-THETA2)-nui( 1 .♦S2)IC0S(BETA2-ThE 
iTwa )  j/D'‘Hon ) 

RETURN 

END 

SUBROUTINE  1N3A  ( A054 . AA55, AAS6. AA57, CAPRB2,HU,RH02, AA5 J , AA53, 
♦Sl,Sc,ftl.ft2,S6,S7,ftA49,AA50.AA48,AA52,Dl.RB2) 

REAL  MU 

THIS  subroutine  COMPUTES  AA54-AA57 

AA54‘CAPRB2«nuiRH02t(AA5I+AA53)-nu»S2lA2 
HA55--MUIRH02iS6t( AA494AA50  ) 

AA56--MUlRH02tS7tl AA49+AA50  ) 

AA57*RB2-MJ»SHiD1-A1  )-nU*RH02l( AA484AA5e  ) 

RETURN 

END 

subroutine  alfa(CAPRB,RB,THETA,CAPRO,RO,ALIN,ALPIN) 

ALIN*  C ( CPPRB4RB  UTAH (THETA )- SORT ( ROIRO-RB I RB ) ) /CAPRB 

AIFIN.S0RT(CAPRC»CAPR0-CAPRB*CAPRB  l^CAPRB 

RETURN 

END 
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